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SECTION  I 

INTRODUCTION  AND  SUMMARY 


1 . 1  Background 

The  Air  Force  Avionics  Laboratory  ( AFAL )  is  participating  in  the  DoD 
Global  Positioning  System  (GPS)  program  with  the  development  of  a  General¬ 
ized  Development  Model  (GDM)  of  GPS  User  Equipment  under  Contract  No.  F33615- 
75-C-1289  to  Collins  Radio  Group  of  Rockwell  International.  The  GDM  is 
being  developed  to  demonstrate  the  performance  capability  of  GPS  User 
Equipment  in  a  hostile  electromagnetic  environment  and  to  broaden  the  tech¬ 
nology  base  for  GPS  User  Equipment(UE) .  In  support  of  this  program,  the 
AFAL  has  developed  in-house  a  linear,  direct  simulation  computer  program  for 
an  integrated  GPS/inertial  aircraft  navigation  system.  This  program,  known 
as  the  Integrated  GPS/inertial  (IGI)  Simulator,  has  been  used  in  a  variety  of 
GPS  UE  design  trade-off  studies  and  mission  analyses. 

AFAL  is  also  funding  the  Westinghouse  Corporation  to  develop  the  Elect¬ 
ronically  Agile  Radar  (EAR).  This  radar  is  integrated  with  the  GEANS  inertial 
navigation  system  (INS)  to  form  a  complete  radar/inertial  navigation  system 
known  as  EAR/GEANS.  GEANS  provides  a  continuous  time  history  of  position, 
velocity  and  attitude  while  EAR  periodically  measures  position  and  velocity. 
The  EAR  measurements  are  blended  with  those  of  GEANS  to  provide  improved  in¬ 
flight  estimates  of  all  navigation  quantities.  The  EAR/GEANS  system  is  to 
begin  flight  tests  in  the  Fall  of  1978  in  a  B- 52  test  aircraft.  A  major 
technical  issue  in  such  tests  is  measuring  how  well  the  integrated  system 
performed  and  then  determining  how  each  subsystem  affected  the  measured 
performance. 

In  order  to  obtain  an  independent  assessment  of  the  navigation  perform¬ 
ance  of  the  EAR/GEANS  system,  AFAL  has  established  an  in-house  project  to 
develop  a  computer  program  capable  of  post-processing  in-flight  recorded 
data.  This  program,  known  as  an  Error  Isolation  Filter  (EIF),  is  a  hiqh- 
order  Kalman  filter/smoother  designed  to  yield  refined  trajectory  estimates 
and  to  detect  off-nominal  performance  in  various  subsystems  (radar,  INS, 
baro-al timeter) . 


1.2  Objectives 

For  the  GPS  GDM  system,  the  AFAL  requires  additional  simulation  and 
software  support  to  properly  address  analysis  problems  in  both  the  GDM  system 
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and  the  IGI  Simulation  program.  This  additional  support  will  reduce  the 
technical,  schedule,  and  cost  risks  associated  with  the  GDM  System  and  at  the 
same  time  aid  the  AFAL  in  development  of  GPS  technology  in  general. 

For  the  EAR/GEANS  system,  the  AFAL  requires  additional  analysis  and 
software  support  to  develop  appropriate  error  models  and  to  code  and  test  the 
EIF  computer  program. 

The  principal  objective  of  the  GPS-related  effort  has  been  to  provide 
software  and  engineering  services  support  for  the  Collins  GDM  program.  That 
support  has  included  adding  capabilities  to  the  AFAL  IGI  Simulation  program 
and  conducting  analyses  of  GPS/inertial  navigation  system  performance  which 
pertain  to  the  GDM.  A  secondary  objective  of  the  GPS-related  effort  has  been 
to  conduct  simulation  studies  with  the  IGI  program  to  benefit  other  present 
and  future  GPS  navigation  systems. 

The  principal  objectives  of  the  EAR/GEANS-related  effort  have  been  to  prc 
vide  analysis  of  AFAL-provided  system  error  models,  synthesis  of  the  EIF  state 
vector,  and  design,  code,  and  preliminary  test  of  the  EIF  software. 


1. 3  Scope  of  Effort 

The  objectives  of  this  effort  have  been  pursued  under  six  defined  tasks. 
These  tasks  are  summarized  in  the  following  paragraphs. 


The  first  task  encompasses  broad  engineering  support  on  the  GDM  software 
development  throughout  the  period  of  performance  on  this  contract.  This  task 
includes  assisting  AFAL  in  technical  review  of  Collins  software  specifications 
simulation  test  programs,  and  navigation  processor  support  software,  and  prov- 
dino  an  independent  verification  and  assessment  of  software  deliverables  on 
the  GDM.  In  addition,  this  task  includes  analysis  of  reduced  INS  control 
gains  for  GPS  receiver  aiding. 


The  second  task  is  to  develop  an  understanding  of  the  AFAL  IGI  Simula¬ 
tion  and  conduct  an  altimeter  modeling  design  study  with  that  simulation. 

This  effort  involves  a  review  of  those  difficulties,  development  of  an  alter¬ 
nate  altimeter  model,  and  demonstration  of  satisfactory  GPS  navigation  system 
performance. 


The  third  task  is  to  implement  in  the  IGI  Simulation  more  detailed  and 
realistic  receiver  error  models  for  the  GPS  range  and  delta-range  measure¬ 
ments.  These  models  will  be  consistent  with  the  fidelity  of  the  existing 
inertial,  altimeter,  and  clock  error  models  in  the  IGI  Simulation. 


The  fourth  task  is  to  implement  in  the  AFAL  IGI  Simulator  an  error  model 
of  a  low-accuracy  strapdown  system.  The  AFAL  IGI  Simulation  currently 
employs  a  model  only  of  a  high-accuracy  local-level  wander-azimuth  inertial 
system. 


1-2 


The  fifth  task  is  to  explore  the  performance  obtainable  with  an  integrated 
GPS/ strapdown  navigation  system  involving  low-accuracy  strapdown  inertial 
sensors . 

The  sixth  task  is  to  provide  engineering  support  to  the  EAR/GEANS  EIF 
development  effort.  This  support  includes  review  of  EAR/GEANS  system  error 
models,  synthesis  of  the  EIF  state  vector,  and  EIF  software  design,  code, 
and  initial  test. 


Overview  of  Rep 


Chapter  2  presents  results  of  the  effort  performed  on  Task  1,  GDM 
Software  Support. 

Chapter  3  presents  results  of  the  effort  performed  on  'ask  2,  Vertical 
Channel  Analysis  and  Simulation. 

Chapter  4  presents  results  of  the  effort  performed  on  Task  3,  Improved 
GPS  Measurement  Models. 


Chapter  5  presents  results  of  the  effort  performed  on  Task  4,  Strapdown 
Inertial  Simulation,  and  on  Task  5,  Integrated  GPS/Strapdown  Performance. 

Chapter  6  presents  results  of  the  effort  performed  on  Task  6,  EAR/GEANS 
Error  Isolation  Filter  Support. 


Conclusions  and  recommendations  for  each  task  area  are  presented  in  the 
corresponding  chapter  of  this  report,  as  outlined  in  the  previous  section. 
These  results  are  briefly  summarized  by  area  in  the  following  two  subsections. 


I, 


1.5.1  GPS  Software  Support  Results 


In  the  first  GPS  area,  GDM  software  support,  Intermetrics  has  analyzed 
several  GDM  technical  problems  and  offered  related  recommendations  to 
Collins.  We  have  recommended  that  the  GDM  software  be  modified  to  incorporate 
a  three-coefficient  compensation  equation  for  the  g-sensitivity  of  onboard 
clock  frequency;  the  least  sensitive  axis  of  the  crystal  clock  should  be 
aligned  with  the  aircraft  yaw  axis.  We  have  recommended  that  t*e  GDM  navi¬ 
gation  software  be  modified  to  compensate  the  azimuth  gyro  g-sensitivity; 
if  such  a  compensation  scheme  is  not  utilized,  the  Kalman  filter  process 
noise  matrix  should  include  an  azimuth  gyro  g-sensitivity  term.  We  have 
recommended  several  possible  techniques  for  stabilizing  rate  aiding  of  the 
non-coherent  mode  of  the  GPS  receiver  by  the  navigation  processor.  These 
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techniques  include  a  filter  feedback  limiter,  reduced  INS  control  gains, 
and  measured  code  loop  error  compensation.  The  stability  of  several  alternate 
rate-aiding  designs  was  explored.  The  baseline  design  (suboptimal  Kalman 
filter  without  stabilization  compensation)  is  unstable  when  the  Kalman  cut¬ 
off  frequency  approaches  the  code  loop  noise  bandwidth,  as  previously 
reported  by  Collins.  The  GDM  stabilization  technique  improved  stability, 
provided  the  compensation  model  is  tuned  to  match  the  lowest-gain  tracking 
loop  dynamics.  The  recommended  alternative  is  to  reduce  the  rate  at  which 
the  estimated  INS  errors  are  controlled  by  the  Kalman  filter;  the  system  can 
thus  be  stabilized  for  Kalman  cut-off  frequencies  more  than  ten  times  faster 
than  for  the  baseline  design.  The  associated  rate-aiding  software  appears 
simpler  than  that  for  stabilization  compensation.  The  stability  improvement 
of  the  reduced-control-gain  technique  is  less  sensitive  to  the  variable 
noise  bandwidth  of  the  code  tracking  loop. 

In  the  second  area,  vertical  channel  analysis  and  simulation.  Intermetrics 
has  identified  and  corrected  problems  causing  poor  vertical -channel  perfor¬ 
mance  in  the  original  Integrated  GPS/Inertial  (IGI)  Simulator,  demonstrated 
proper  performance  for  a  low-dynamic  C5  mission,  and  compared  simulated 
performance  of  three  vertical -channel  filter  designs  for  a  high-dynamic  F4 
mission.  The  two  most  significant  vertical -channel  changes  to  the  IGI 
Simulator  were  changing  the  Kalman  filter  altimeter  bias  state  from  a  random 
constant  to  a  random  walk,  and  correcting  an  error  in  the  simulated  GPS 
pseudo-range-rate  measurement  model.  Simulation  results  for  the  C5  mission 
demonstrate  GPS/inertial  navigation  errors  consistent  both  with  filter- 
computed  uncertainties,  and  wifh  Intermetrics 1  prior  experience  of  GPS/ 
inertial  accuracy  achievable.  Simulator  results  for  the  F4  mission  compared 
three  vertical -channel  fil ter  model s:  a)  altimeter  bias  plus  scale-factor 
error  states,  b)  bias  error  state,  and  c)  scale  factor  error  state.  All 
three  designs  provide  virtually  identical  navigation  performance  when  GPS 
measurements  are  available.  However,  when  GPS  signals  are  not  available 
(e.g.,  during  severe  jamming),  and  the  aircraft  is  simultaneously  performing 
climbing  or  diving  maneuvers,  filter  a)  performs  better  than  b),  and  b) 
better  than  c);  vertical-  channel  errors  were  approximately  in  the  ratio  of 
2:3:4  for  the  F4  tactical  mission  simulated. 

In  the  third  area,  improved  IGI  Simulator  models.  Intermetrics 
produced  and  documented  an  upgraded  Simulator  program.  Emphasis  was  placed 
on  high-fidelity  barometric  altimeter  models,  high-fidelity  GPS  pseudo-range 
and  delta-pseudo-range  error  models,  and  on  program  structural  changes. 
Simulated  ba ro-a 1  time  ter  errors  include  the  effects  of  pressure-al ti tude 
error,  scale  factor  error,  due  to  non-standard  temperature,  static  pressure 
defect,  and  altimeter  lag.  Simulated  pseudo-range  errors  include  the  effects 
of  GPS  satellite  clock  phase  drift  and  ephemeris  error,  atmospheric  delays, 
user  clock  phase  drift,  and  receiver  phase  noise.  Simulated  delta-pseudo¬ 
range  errors  include  the  effects  of  time  rates-of-change  of  the  pseudo-range 
errors,  e.g.,  user  clock  frequency  drift.  This  version  of  the  Simulator 
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also  implements  the  original  high-fidelity  error  model  for  the  l itton  TAINS 
LN-15  baro- inertial  navigation  system  (INS),  structured  in  generalized  form. 

In  the  fourth  and  fifth  task  areas,  integrated  GPS/str«pdown 
performance.  Intermetrics  added  a  strapdown  Inertial  navigation  system  error 
model  to  the  IGI  Simulator,  and  obtained  simulation  results  typifying  strap- 
down  performance  for  a  high-dynamic  F4  trajectory.  The  strapdown  INS 
error  model  Implemented  is  that  for  the  Honeywell  SIGN- II I  baro- inert ial 
navigator,  structured  in  a  generalized  form.  Simulated  performance  results 
were  obtained  for  a  typical  strapdown  baro- Inert ial  navigator  under  the  high- 
dynamic  F4  flight  environment.  These  results  demonstrate  significant  degra¬ 
dation  in  INS  attitude  errors  as  a  result  of  sustained  maneuvering.  Hu ring 
circling  flight,  strapdown  attitude  errors  were  large  compared  with  those  ot 
a  typical  local-level  (gimballed)  inertial  system  in  the  same  environment. 

The  resulting  horizontal  velocity  and  position  errors  of  the  strapdown 
system  were  also  comparatively  large.  The  dominant  strapdown  instrument 
error  sources  were  gyro  torguer  scale  factor  errors  and  misalignments,  and 
gyro  g-sensitive  drift  rates. 


1.5.2  IAR/GEANS  Software  Support  Results 

In  the  sixth  area,  EAR/GEANS  Error  Isolation  Filter  (E1F)  support , 
Intermetrics  has  analyzed  several  aspects  ot  the  TIT  computer  program  develop¬ 
ment,  flight  data  recording  requirements,  EAR/GEANS  error  models,  and  opti¬ 
mal  filter/ smoother  mechanization  equations. 

The  EIE  development  plan  describes  five  principal  steps  in  computer 
program  development  and  qualification:  i)  analysis,  ii)  top-level  design 
and  interface  definition,  iii)  detailed  design  and  coding,  iv)  testing,  and 
v)  maintenance.  Sequencing,  scheduling,  and  man-loading  requirements  have 
also  been  addressed. 

EAR/GEANS  flight  data  recording  requirements  developed  bv  AT  At  were 
reviewed  and  found  adequate.  High  data-rate  specific  force  need  not  be 
recorded,  but  can  be  computed  with  sufficient  accuracy  tor  til  error  propa¬ 
gation  bv  back-d 1 fferenc inq  of  inertial  velocity  data  (with  gravity  compen¬ 
sation)  . 

Intermetrics  has  reviewed  AFAL -developed  error  models  for  the  I  AR  Gt  ANs 
vertical  channel,  fundamental  dynamics  of  the  GIANS  baro-damped  space-stable 
inertial  navigator,  and  I AR  radar  measurements  and  measurement  matrices.  We 
have  noted  that,  for  a  second-order  damping  loop  in  the  vertical  channel  , 
measurements  of  aircraft  altitude  alone  do  not  provide  observability  ot 
vertical  velocity  error,  or  separation  ot  vertical  acceleration  and  barometric 
altitude  bias  errors.  Observability  and  separability  reguire  either 
difference  measurements  of  Inertial  minus  barometric  altitude,  or  direct 
vertical  velocity  measurements.  We  have  concurred  with  the  fundamental  error 


dynamics  model  for  the  baro-damped  space-stable  navigator,  with  the  excep¬ 
tion  of  certain  approximations  to  geodetic/geocentric  coordinate  transforma¬ 
tions.  Also,  in  the  gyro  drift  model,  two  /-gyro  drift  states  are  inseparable 
and  should  be  estimated  as  a  single  combined  error  source.  We  have  also 
concurred  with  the  EAR  measurement  models  and  measurement  matrices  developed 
by  AFAL,  insofar  as  geometric  relationships  between  measurements  and  system 
error  sources  are  concerned.  There  remain  some  questions  regarding  measure¬ 
ment  error  statistical  characteristics,  e.g.,  time-correlation  of  errors, 
and  cross-coupl ing  between  measurements. 

Intermetrics  has  reviewed  the  current  literature  on  gravity  perturba¬ 
tion  modeling.  Four  representative  space-domain  gravity  perturbation  models 
have  been  examined,  and  their  transfer  to  the  time  domain  under  various 
vehicle  maneuvers  analyzed.  None  of  the  models  adequately  represent  the 
physical  process  during  aircraft  turns,  or  during  repeated  passes  over  the 
same  ground  track.  Hence  differences  in  theoretical  completeness  and 
frequency  content  of  these  gravity  models  are  somewhat  academic.  For  purposes 
of  EAR/GEANS  EIF  development,  the  simulated  environment  model  for  gravity 
perturbations  should  be  of  higher  faithfulness  to  the  real  world  than  the 
EIF  estimator  model.  A  deterministic  space-domain  gravity  model  is  recommended 
for  the  environment  simulator,  including  local  high- frequency  perturbation 
content.  The  EIF  gravity  model  should  account  for  the  following  factors: 

i)  local  gravity  perturbation  biases  due  to  low-frequency  global  harmonics; 

ii)  weak  separability  of  gravity  perturbation  components  from  accelerometer 
biases;  iii)  cross-correlations  between  gravity  perturbation  components; 
and  iv)  non-uniform  transformation  from  space  to  time  domain  during  turns. 

Intermetrics  has  recommended  the  LAR/GEANS  Ilf  filter  formulat ion, 
including  the  definitions  of  the  filter  state  vector,  process  noise  covariance 
matrix,  state  transition  matrix,  initial  state  vector  estimate,  and  initial 
state  error  covariance  matrix.  The  recommended  filter  state  vector  consists 
of  44  components*:  three  position  errors,  three  velocity  errors,  three  plat¬ 
form  tilts,  three  accelerometer  biases,  three  accelerometer  scale-factor 
errors,  three  accelerometer  misalignments  (remaining  three  are  zero  by 
definition  of  ideal  platform  frame),  three  gyro  biases  (z  term  includes 
inseparable  torquing  error),  six  gyro  q-sensitive  drift  coefficients,  three 
baro-al timeter  error  sources,  three  antenna  misalignments  relative  to  case, 
three  gimbal  angle  biases  (fourth  is  inseparable  from  z-component  of  antenna/ 
case  misalignment),  three  radar  range/range-rate  errors,  two  monopulse 
angle-cosine  errors,  and  three  gravity  perturbation  components.  The  process 
noise  covariance  matrix  represents  random  or  unmodeled  state  driving  noises; 
tiie  latter  are  modeled  by  trajectory-dependent  noise  power  density.  The 
state  transition  matrix  is  represented  by  a  first-order  expansion  in  the 

*  1 

Current  version  of  EIF  state  vector. 
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integral  of  the  fundamental  dynamics  matrix.  The  initial  state  vector  esti¬ 
mate  is  zero,  and  the  initial  state  error  covariance  matrix  is  computed  in 
terms  of  rms  Schuler  position,  velocity  and  tilt  errors  plus  rms  instrument 
errors . 

The  EAR/GEANS  onboard  navigation  filter  estimates  13  states  pertaining 
to  the  INS,  altimeter,  and  antenna  subsystems.  In  the  feedback  mode,  all 
thirteen  filter  states  are  utilized  to  correct  data  outputs  from  those 
subsystems.  During  post-flight  analysis,  certain  EIF  error  states  must  be 
adjusted  to  compensate  for  feedback-correction  jumps  in  the  EAR/GEANS 
outputs.  Adjustments  are  required  in  ten  of  the  corresponding  thirteen  EIF 
states:  three  position  errors,  three  velocity  errors,  three  platform  tilts, 
and  one  altimeter  bias;  the  three  antenna  misalignments  require  no  adjustment, 
since  the  EIF  does  not  use  onboard  antenna  attitude  as  its  nominal  value. 

The  forward  pass  of  the  EAR/GEANS  EIF  implements  a  forward-recursive 
optimal  filter;  the  backward  pass  implements  a  backward-recursive  optimal 
filter  plus  optimal  smoother.  Intermetrics  recommends  that  the  optimal 
filters  be  implemented  as  Kalman  filters  in  triangular  square  root  form,  and 
the  optimal  smoother,  as  a  Fraser  two-filter  smoother  in  triangular  square 
root  form.  These  algorithms  are  recommended  since  among  existing  formulations, 
they  are  the  most  stable  numerically,  and  nearly  the  most  efficient  computa¬ 
tionally.  A  modest  increase  in  filter  efficiency  is  possible  using  the 
II, D  factored  form  of  the  triangular  square  root  equations;  however,  the 
improvement  is  not  sufficient  to  warrant  recoding  and  retestinq  of  available 
triangular  square  root  subroutines. 
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SECTION  II 

GDM  SOFTWARE  SUPPORT 


2 . 1  Chapter  Summary 

Intermetrics  has  reviewed  various  aspects  of  the  Collins  GDM 
navigation  and  receiver-aiding  software  design.  Specific  tech¬ 
nical  issues  that  have  been  analyzed  in  greater  depth  are  the 
following : 

i)  Clock  frequency  g-sensitivity  modeling  and  compensation; 

ii)  Azimuth  gyro  g-sensitivity  calibration  and  compensation; 

iii)  Continuity  of  Kalman  filter  feedback  to  receiver  aiding; 

iv)  Stability  of  receiver  aiding  in  non-coherent  mode; 

v)  Stability  of  alternate  designs  for  rate  aiding  of  non¬ 
coherent  mode  of  a  GPS  receiver. 

These  topics  are  discussed  in  the  following  five  sections,  2.2 
to  2.6. 


2 . 2  Clock  Frequency  G-Sensi tivi ty  Modeling  and  Compensation 

This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#03-77  .  bu  William  S.  Widnall,  dated  31  Jtugust  1077  [17]. 

This  technical  memo  documents  recommendations  that 
have  previously  been  made  to  Collins  personnel  concerning 
compensation  of  the  clock  frequency  G-sensitivity  in  the 
AFAL/Collins  GPS/GDM. 


2.2.1  Technical  Discussion 

Crystal  clocks  are  sensitive  to  the  applied  specific 
force.  It  is  thought  that  a  simple  linear  model  adequately 
describes  the  shift  in  frequency  due  to  applied  specific 
force.  See  for  example  Ref.  [1].  The  contribution  to 
pseudo-range-rate  measurement  error  6r  is 


6r  =  &rQ  +  c  •  f  (2.2-1) 

where  c  is  the  clock  frequency  g-scnsi ti vi ty  vector,  f  is 
the  specific  force  vector  in  aircraft  coordinates,  and  6r0 
denotes  the  error  in  measured  pseudo  range  rate  due  to 
other  effects. 

The  g-sensitivity  effect  can  be  quite  significant. 

This  author  has  not  seen  test  data  for  the  GDM  clock 
(HP  10544A) .  However  typical  values  for  crystal  clocks  are 
of  the  order  of  0.1  meter/sec/g  for  the  least  sensitive 
axis  to  1.0  meter/sec/g  for  the  most  sensitive  axis.  If 
not  calibrated  and  compensated,  this  t»ffect  may  limit  the 
achievable  narrow-tracking- loop  bandwidths  and  therefore  th 
achievable  anti-jamming  performance.  The  Collins  design  di 
not  include  such  compensation. 


2.2.2  Recommendations 

We  have  recommended  that  the  GDM  software  be  modified 
to  incorporate  a  compensation  equation  for  the  g-sensitivity 
of  the  clock  frequency.  Three  coefficients  would  be  stored. 


— 


which  would  be  used  to  multiply  the  three  components  of 
specific  force  to  obtain  the  expected  frequency  shift.  The 
three  coefficients  would  be  obtained  from  laboratory  testing 
or  from  flight  data  analysis  using  the  Error  Isolation  Filter. 

The  least  sensitive  axis  of  the  crystal  clock  should  be 
mounted  in  the  aircraft  lift-vector  direction.  The  most 
sensitive  axis  should  be  mounted  in  the  aircraft  lateral 
direction. 

Residual  errors  after  compensation  should  be  modeled 
in  the  Kalman  filter  with  appropriate  maneuver-dependent 
state  driving  noise  and  measurement  error  variance. 


2.2.3  Status 

The  recommendation  that  compensation  for  clock-frequency 
g-sensitivity  be  included  in  the  GDM  software  was  made 
verbally  to  Collins  personnel  at  a  technical  interchange 
meeting  at  Cedar  Rapids,  on  14-16  February  1977.  At  a  later 
meeting  on  26  April,  Dick  Carroll  indicated  that  Collins  has 
implemented  three  calibration  coefficients  in  the  software. 

He  also  indicated  that  maneuver- dependent  clock  phase  error 
state  driving  noise  has  been  added  in  the  filter. 


2  _  3  Az imuth  Gyro  G-Sensi tivity  Calibration  and  Compe n s  a  tion 

This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
♦05-77 ,  by  William  S.  Widnall,  dated  31  August  1977  [lGj. 

This  technical  memo  documents  recommendations  that  have 
previously  been  made  to  Collins  personnel  concerning  the 
calibration  and  compensation  of  the  azimuth  qyro  g-sensi- 
tivity  in  the  IMU  of  the  AFAL/Col 1 ins  GPS/GDM. 


2.3.1  Technical  Discussion 

The  KT-70  inertial  measurement  unit  azimuth  gyro  has 
an  uncompensated  sensitivity  to  vertical  specific  force 
of  about  4°/hr/g  (data  from  Collins  personnel).  The  steady 
gyro  drift  rate  of  about  4°/hr  in  the  one-g  environment  due 
to  this  effect  is  compensated  for  in  the  navigation  software 
by  proper  choice  of  the  calibration  value  for  azimuth  gyro 
drift  rate.  However  changes  in  gyro  drift  rate  due  to 
changes  in  the  vertical  specific  force  are  not  compensated. 

The  short-durat ion  variations  in  vertical  specific  force  due 
to  pull-up>s  or  push-downs  are  not  of  great  significance. 

More  important  is  the  long-duration  change  in  vertical 
specific  force  associated  with  flying  at  a  different  altitude. 

Gravity  strength  decreases  with  altitude  approximately 
as 


g(h)  *  gQ  ( 1  -  2  h/re)  (2.3-1) 

where  g0  is  the  sea-level  strength  of  gravity,  re  is  earth 
radius,  and  h  is  the  altitude  above  sea  level.  The  vertical 
specific  force,  neglecting  maneuver  acceleration  and  Coriollis 
acceleration,  is  equal  to  gravity 


f2  3  g(h)  (2.3-2) 

The  azimuth  gyro  drift  rate  due  to  this  specific  force  is 


6uiz  =  DZ z  gQ(l  -  2  h/re)  (2.3-3) 
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where  DZ2  denotes  the  g-sensitivity .  The  change  in  this 
drift  rate  between  sea-level  and  an  altitude  h  is 


A  5u>z  =  -DZz  gQ  2  h/re  (2.3-4) 

At  30,000  ft  altitude  and  assuming  DZz  =  4°/hr/g  (and  using 
re  =  20,900,000  ft),  the  change  in  gyro  drift  rate  is 


A  5io  =  -0 . 012°/hr  (2.3-5) 

z 

This  is  a  significant  change  in  gyro  drift  rate.  However 
without  some  simulation  results,  this  author  cannot  say  if 
such  a  change  will  have  a  significant  impact  on  navigation 
and  receiver  aiding  accuracy. 


2.3.2  Recommendations 

We  have  recommended  that  the  GDM  navigation  software  be 
modified  to  compensate  the  azimuth  gyro  g-sensitivity.  The 
compensation  coefficient  can  be  measured  from  IMU  laboratory 
test  data  and/or  from  flight  recorded  data  (using  the  Error 
Isolation  Filter) . 

If  such  compensation  is  not  adopted,  the  effect  of  the 
changes  in  gyro-drift  rate  perhaps  can  be  minimized  by 
providing  adequate  state  driving  noise  variance  in  the  Kalman 
filter  model  for  azimuth  gyro  drift  rate. 


2.3.3  Status 

The  recommendation  that  Collins  consider  compensating  the 
z  gyro  g-sensitivity  was  made  verbally  to  Collins  personnel 
at  a  technical  interchange  meeting  at  Cedar  Rapids  on 
14-16  February  1977.  It  is  my  understanding,  based  on  my 
2  August  telephone  conversation  with  Dick  Carroll,  that  the 
compensation  recommendation  was  not  adopted. 
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-  •  ^  Continuity  of  Kalman  Filter  Feedback  to  Receiver  Aidinu 

This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#04-77,  by  William  S.  Widnall,  1]  •■'ucus*-  'an  Mo*l 

*"  '  k  *  **  «#  • 

This  technical  memo  documents  recommendations  that  have 
previously  been  made  to  Collins  personnel  concerning  possible 
discontinuities  in  the  receiver  rate  aiding  due  to  Kalman 
filter  feedback  of  error  estimates  in  the  AFAL/Collins  GPS/ 

GDM. 


2.4.1  Technical  Discussion 

The  rate-aided  receiver  tracking  loops  for  one  channel 
of  the  GDM  are  shown  in  Figure  1.  Illustrated  are  the 
variables  associated  with  tracking  a  single  satellite. 
Similar  diagrams  apply  to  the  simultaneous  tracking  of  the 
other  satellites.  Functions  shown  include  the  receiver 
rate  aiding,  the  carrier  tracking,  and  the  code  tracking. 


The  receiver  rate  aiding  variable  VAID  for  each  channel 
is  obtained  from  the  navigation  computer.  In  the  initial 
Collins  design  (see  Ref.  [2],  p.  313,  Eq .  (3. 2. 3. 3-6))  VAID 

was  comprised  of 


VAID  -  Rs  -<VDra  *  SVR) 


e  +  e  v 
T  F 


(2.4-1  ) 


where 


V 


DYN 


Computed  range  rate  of  the  satellite  assuming 
zero  user  antenna  velocity  with  respect  to  earth. 

Inertial  navigation  indicated  velocity  plus 
computed  antenna  velocity  relative  to  the 
inertial  measurement  unit. 


T 

c  V. 


Unit  vector  to  the  satellite  from  the  user. 

Estimated  user  clock  velocity 
Kalman  filter 


or  ror 


from  the 


6V  =  Filter-feedback  smoother  vector 
R 

The  f i Iter- feedback  smoother  vector  was  designed  to  prevent 
discontinuities  in  the  Kalman  fi Iter  estimates  of  INS 
velocity  error  from  causing  discontinuities  in  VAID.  The 
inertial  indicated  velocity  V  is  altered  discontinuously  by 
the  navigation  filter  at  the  start  of  the  filter  loop  (every 
5  sec) 


(2.4-2) 


where  5VC  is  the  Kalman  filter  best  estimate  of  the  velocity 
error.  At  the  same  time,  the  filter-feedback  smoother  vector 
was  altered  to  offset  this  velocity  discontinuity  (see  Ref.  (2) 
p.  227,  Eq.  ( 3 . 2 . 2 . 2 . 3-7b) ) 


6V  ~  +  <5 V 

R  c 


(2.4-3) 


The  filter-feedback  smoother 
at  a  very  low  rate  (see  Ref. 


-0.02 


vector  was  then  driven  to  zero 
(2) 


p- 

313, 

Eq  . 

(3.2.3. 

3-7)  ) 

sgn 

6vrx 

sgn 

6vry 

m/s^ 

(2.4-4) 

sgn 

6vrz. 

Preventing  discontinuities  in  the  VAID  signal  is  necessary 
to  prevent  loss  of  carrier  tracking.  As  seen  in  Figure  1,  the 
rate  aiding  variable  VAID  feeds  directly  into  the  command  to 
the  carrier  digital  VCO.  Carrier  tracking  error  must  be  held 
to  a  few  centimeters.  The  carrier  tracking  loop  time  constant 
is  of  the  order  of  one  sec.  Hence  discontinuities  in  the 
receiver  aiding  signal  greater  than  about  0.02  m/sec  per  sec 
are  likely  to  cause  cycle  slipping  or  loss  of  coherent  tracking 

The  initial  Collins  design  was  good  as  far  as  it  went. 
However,  we  pointed  out  that  the  design  did  not  suppress  the 
effect  of  discontinuities  in  the  Kalman  filter  estimates  of 
clock  frequency  error. 


2.4.2 


Recommendations 


We  recommended  that  the  GDM  navigation  computer  soft¬ 
ware  be  modified  to  incorporate  limiting  of  the  Kalman  filter 
feedback  of  the  clock  frequency  estimates  to  the  receiver 
aiding . 


2.4.3  Status 


The  recommendation  concerning  the  clock  frequency 
estimates  and  receiver  aiding  was  made  verbally  to  Collins 
personnel  at  a  technical  interchange  meeting  at  Cedar  Rapids 
on  14-16  February  1977.  At  a  later  meeting  on  26  April, 
Collins  personnel  indicated  that  they  have  redesigned  the 
continuity  logic  in  the  following  manner.  The  receiver  rate 
aiding  variable  for  each  channel  is  now  comprised  of 


VAID  =  R  - 
s 


V 


DYN 


nv„  +  6v 


(2.4-5) 


where 


SV  =  Filter  feedback  smoother  variable  for  one  channel 
only 


and  the  other  variables  are  as  previously  defined.  The 
inertial  indicated  velocity  V  is  altered  discontinuously  by 
the  Kalman  filter  as  before  (Eq.  (2)).  The  estimated  clock 
frequency  error  is  altered  discontinuously  by  the  Kalman 
filter  as  before 


AV 


FC 


i  2 . 4-6 ) 


where  AVpc  is  the  Kalman  filter  computed  change  in  clock 
frequency  error  estimate.  At  the  same  time,  the  filter-feed¬ 
back  smoother  variable  for  each  channel  is  altered  to  offset 
these  discontinuities 

*V  -  *V  -  <VC  •  iT  ♦  AVFC  (2.-1 

The  filter-feedback  smoother  variables  are  driven  to  zero  at 
the  very  low  rate 


2-  0 


5Vr  =  -0.02  sgn  5VR  m/s2 
This  looks  like  a  good  implementation. 
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2.5 


Stabil _i ty  of  Receiver  Aiding  in  Non-Coherent  Mode 


This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#  06-77,  by  William  S.  Widnall,  dated  16  September  1977[20]. 

This  technical  memo  discusses  the  known  potential 
instability  of  the  non-coherent  mode  of  the  AFAL/Collins 
GPS/GDM.  Concerns  are  expressed  as  to  the  desirability  and 
adequacy  of  the  design  changes  that  have  been  made  to 
correct  the  stability  problem.  An  alternate  approach 
previously  suggested  to  Collins  personnel  by  the  author  is 
documented  in  this  memo.  Also  presented  here  are  two 
additional  alternate  approaches. 


2.5.1  Technical  Discussion 

Collins  designers  have  been  aware  that  a  potential 
stability  problem  exists  in  the  GPS/GDM  non-coherent  mode. 

The  problem  is  associated  with  the  closed-loop  Kalman  filter 
and  the  very  narrow  code  tracking  loop  bandwidths.  It  was 
discussed  by  Collins  personnel  at  the  Critical  Design  Review 
Meeting  in  December  1976,  Ref.  [3]  .  The  essence  of  the 
problem  is  that  the  tracking  loop  bandwidths  are  made  as  slow 
as  possible  to  reject  wide-band  noise  due  to  jammers.  This 
causes  long-correlation-time  errors  in  the  pseudo-range 
measurements.  The  navigation  Kalman  filter  that  blends  the 
GPS  and  INS  data  is  sub-optimal  and  does  not  model  the  long- 
correlation  time  pseudo-range  errors.  The  estimates  of 
navigation  errors  from  the  Kalman  filter  are  fed  to  the 
inertial  navigation  equations  to  provide  closed-loop  control 
of  the  inertial  navigation  errors.  The  corrected  inertial 
navigation  variables  are  in  turn  used  to  compute  estimated 
range-rates  to  the  GPS  satellites  to  be  used  for  receiver 
aiding.  If  a  channel  is  in  the  non-coherent  mode  (carrier 
loop  not  tracking) ,  the  receiver  aiding  is  applied  directly 
to  the  code  loop.  It  turns  out  that  this  rather  complex 
system  may  be  unstable. 

An  analysis  of  this  problem  and  a  discussion  of  the 
implemented  design  changes  are  presented  by  Will  Mickelson 
of  Collins  in  Ref.  [4].  A  very  readable  paper  by  Dick  Carroll 
and  Will  Mickelson  on  the  same  subject  was  later  presented  at 
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the  NAECON  meeting,  Ref.  [5  ] .  The  design  approach  adopted 
includes  the  addition  of  compensation  equations  in  the 
navigation  computer  that  model  approximately  the  responses 
of  the  code  tracking  loops  to  the  Kalman  filter  feedback. 
These  modeled  responses  are  subtracted  from  the  pseudo-ranqe 
measurements  obtained  from  the  receiver  computer.  Figure  2 
(from  Ref.  [5  ])  summarizes  the  information  flow.  (Where  it 
says  "INS  Vertical  Loop",  read  "INS  Equations".)  An 
additional  change  adopted  is  that  the  code  tracking  loop 
bandwidths  have  been  increased.  Linear  stability  analyses 
are  presented  in  Refs.  [4  ]  and  [5  ]  that  show  the  benefits 
of  these  changes. 


Figure  2:  Generalized  Information  Flow  Diagram 


This  author  has  pointed  out  a  disadvantage  of  these  changes. 
Wider  code  tracking  loop  bandwidths  have  been  adopted.  This 
gives  up  something  in  terms  of  anti-jamming  performance. 
Generally  one  wants  to  have  the  bandwidths  as  narrow  as 
possible,  limited  only  by  the  physical  considerations  associated 
with  the  vehicle  dynamics  and  the  dynamic  errors  of  the  aiding 
signals  and  of  the  clock.  It  is  not  desirable  to  adopt  wider 
bandwidths  to  help  solve  this  stability  problem. 

This  author  has  also  expressed  a  fundamental  concern  that 
the  modified  system  may  still  be  unstable.  The  stability 
analysis  presented  in  Ref.[  4]  and[  5]  is  a  classical  frequency 
domain  analysis  employing  a  fundamental  assumption  that  the 
Kalman  filter  gains  remain  at  low  steady  state  values. 

Stability  is  demonstrated  for  cases  where  the  Kalman  filter 


response  time  is  not  significantly  faster  than  the  code-loop 
response  time.  However,  it  is  a  known  and  desirable  character¬ 
istic  of  Kalman  filters  that  they  have  time-varying  gains. 

This  permits  them  to  make  optimal  use  of  the  measurements  as 
a  function  of  changing  measurement  geometry  and  changing 
data  availability.  After  a  period  of  loss  of  signal,  such 
as  due  to  wing  shadowing  in  a  turn  or  due  to  jamming,  the 
Kalman  filter  will  have  increased  its  gains  so  as  to  put 
greater  weight  on  the  GPS  measurements  (relative  to  the  INS 
dead  reckoning) .  How  much  these  gains  increase  over  their 
minimum  values  is  a  function  of  how  long  is  the  period  of  no 
GPS  measurements.  It  is  quite  possible  that  at  higher  gain 
levels,  at  which  the  Kalman  filter  response  time  ij;  signifi¬ 
cantly  faster  than  the  code- loop  response  time,  the  system 
may  again  be  unstable. 


2. 5. 2.1  Filter  Feedback  Limiter.  A  fundamental  observation  is  that 
if  the  receiver-aiding  was  not  a  function  of  the  Kalman  filter 
error  estimates,  then  there  would  be  no  stability  problem. 

However,  zero  filter  feedback  is  undesirable  for  two  reasons: 

1.  The  vertical  channel  would  have  to  be  stabilized  in  some 
other  way  (such  as  a  conventional  non-Kalman  baro-inertial 
vertical  channel).  2.  the  INS  attitude  errors,  especially 
the  azimuth  error,  would  grow  uncontrolled  during  a  flight 
causing  a  larger  maneuver-dependent  error  in  the  velocity  aid. 

The  author  has  made  the  following  suggestion  to  Collins 
personnel.  Consider  using  the  filter-feedback  limiter 
concept  of  the  coherent  mode  also  in  the  non-coherent  mode. 

The  filter-feedback  limiter  concept  active  in  the  non-coherent 
mode  ensures  continuity  of  the  receiver  aiding  signal  by 
storing  up  the  discontinuous  Kalman  filter  velocity-error  and 
clock- f requency-er ror  estimates  and  metering  out  the  related 
changes  to  the  receiver  aiding  signals  at  a  rate  currently 
limited  at  0.02  m/s*-.  In  the  present  design,  the  feedback 
limiter  is  not  used  in  the  non-coherent  mode.  If  the  limiter 
were  retained  in  the  non-coherent  mode,  it  is  possible  that 
the  limiter  could  suppress  the  stability  problem.  Assume 
that  the  system  is  unstable  without  the  limiter.  Further 
assume  that  the  frequency  of  oscillation  is  about  .03  rad/sec 
(the  resonant  frequency  shown  in  Figure  8  of  Ref.  [5]).  The 
period  of  oscillation  is  then  about  200  sec.  If  the  filter- 
feedback  limiter  is  set  at  0.02  m/s‘  (current  setting  in 
non-coherent  mode),  then  a  possible  system  limit  cycle  would 
be  as  exhibited  in  Figure  3.  The  limit  cycle  amplitude  miaht 
be  50  meters,  which  is  unacceptable.  If  the  feedback  limiter 
were  set  at  0.001  m/s2,  the  limit  cycle  amplitude  might  be 
2.5  m,  which  is  acceptable. 
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2.5.3  Reduced  INS  Control  Gains.  There  mav  he  other  considera¬ 
tions  which  make  it  undesirable  to  reduce  the  filter  feed¬ 
back  limiter  to  the  order  of  0.001  m/s^.  An  alternate  idea 
is  to  reduce  the  loop  gain  that  is  causing  the  instability  by 
introducing  reduced  INS  control  gains.  The  present  Collins 
GDM  design  applies  the  full  value  of  the  error  estimates  from 
the  Kalman  filter  to  the  INS  and  clock  variables.  These  full 
corrections  are  applied  at  the  next  filter  cycle,  5  sec  after 
the  measurements.  If  instead  say  only  5%  of  the  estimated 
errors  were  corrected  each  5  sec,  then  the  filter  feedback 
gain  has  been  reduced  by  a  factor  of  20.  As  long  as  the 
control  action  is  properly  modeled  in  the  Kalman  filter, 
there  is  no  loss  of  estimation  accuracy. 

These  new  control  gains  cannot  be  made  arbitrarily  small, 
because  the  unaided  vertical  channel  is  unstable.  In  the 
example  of  5%  feedback  each  5  sec,  this  has  a  feedback  time 
constant  of  the  order  of  100  sec.  It  probably  can  be  shown 
that  this  is  adequate  to  stabilize  the  vertical  channel.  A 
time  constant  of  1000  sec  on  the  other  hand  is  probably  too 
weak  to  stabilize  the  vertical  channel. 

The  merit  of  this  idea  can  be  explored  by  a  linear 
constant  coefficient  stability  analysis  employing  similar 
assumptions  to  those  employed  in  Refs.  [4]  and['5].  The 
inertial  navigation  errors  plus  the  code  tracking  loop  errors 
are  modeled  as  being  governed  by 


xfc  =  xfc  +  w  +  Au 


(2.5-1) 


where  x^  is  true  error  state  vector.  Ft  is  its  fundamental 
matrix,  w  is  a  vector  of  white  noise  disturbances,  u  is  the 
error  control  vector,  and  A  is  a  matrix  allocating  the  error 
control  vector  to  some  of  the  states.  A  vertical  channel 
analysis  could  have  five  states:  three  INS  errors,  and  two 
code  tracking  loop  errors,  as  in  Refs.  [4]  and  [5)  The 
Kalman  filter  processes  a  measurement  vector  z 


z  =  Hxfc  +  v 


(2.5-2) 


where  H  is  the  measurement  gradient  matrix  and  v  is  a  vector 
of  white  noises.  The  vertical  channel  stability  analysis  can 
consider  a  single  ranging  measurement,  ignoring  the  less 
accurate  altimeter  measurement,  as  in  Refs.  [4  ]  and  [5}  The 
Kalman  filter  can  be  modeled  as  being  an  analoq  filter  governed 
by 
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2.5-3) 


x^  =  F^  x^  +  u  +  K  ( z  -  HXj.) 

where  xt-  is  the  filter  state  vector,  Ff  is  its  fundamental 
matrix,  u  is  the  same  control  vector  as  in  Eq.(-l) ,  ami  K  is 
the  Kalman  gain  matrix.  The  Kalman  filter  is  sub-optimal, 
not  modeling  the  code  tracking  loop  error  states.  The 
vertical  channel  stability  analysis  considers  the  Kalman 
filter  as  having  only  three  states,  estimating  the  INS 
vertical  channel  errors. 

In  the  present  Collins  design,  the  full  value  feedback 
control  is  essentially 


u  =  -K(z  -  Hx^) 


(2.5-4) 


This  clamps  the  filter  estimates  at  zero,  and  provides  true 
errors  governed  by 


x  =  IF  -  AKH)xt  +  w  -  AKv  (2.5-5) 

The  above  equation  is  derived  by  using  E<J.(-2)  in  Eq.(-4)  , 
by  assuming  xf  in  Eq.(-4)  is  held  at  zero,  and  by  using 
Eg. (-4)  in  Eq.(-l).  The  stability  of  the  system  can  be 
explored  by  examining  the  roots  of  the  characteristic  equation 

det ( s  I  -  F  +  AKH )  »  0  (2.5-61 

This  would  bo  a  fifth  order  characteristic  equation  for  three 
INS  errors  and  two  code  loop  errors  (and  without  the  stabiliza¬ 
tion  compensation  two  states)  . 

In  the  alternate  design  suggested  here,  the  feedback  is 
reduced  by  introducing  a  gain  matrix  C 


u  =  -C  xf 


(2.5-7) 


The  filter  estimates  are  no  longer  clamped  at  zero.  The 
combined  truth  and  filter  states  are  governed  by 
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(2.5-8) 
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The  xt  row  of  Eq.(-8)  is  obtained  by  using 
The  Xf  row  of  Eq.(-8)  is  obtained  by  using 
Eq  .  ( - 7 )  in  Eq . ( - 3 )  •  The  stability  of  this 
can  be  explored  by  examining  the  roots  of 
equation 


Eq. (-7)  in  Eq. (-1)  . 
Eq . ( - 2 )  and 
alteri ate  system 
the  characteristic 


det (s  I  -  F)  =  0 


(2.5-9) 


where  F  is  the  combined  fundamental  matrix  of  Eq.(-8) .  This 
would  be  an  eighth  order  characteristic  equation  for  three 
INS  errors,  two  code  loop  errors,  and  three  filter  states. 

Normally  one  would  choose  the  C  matrix  to  be  diagonal 
(altitude  error  estimate  controls  INS  altitude,  etc.).  The 
diagonal  elements  could  all  be  chosen  for  simplicity  as 
having  equal  values.  Values  of  0.01  in  this  analog  analysis 
would  correspond  to  the  discrete  5%  feedback  every  5  sec. 

The  Kalman  filter  gains  for  this  analysis  should  be  set 
significantly  higher  than  in  the  analysis  of  Refs.  [4]  and 
[5],,  This  is  to  explore  the  stability  associated  with  higher 
gains  after  loss  of  measurements. 


2.5.4  yaasured  Code  Loop  Error  Compensation.  A  third  Stabili¬ 
zation  idea  is  presented  here.  Consider  measuring  the  code 
loop  error  offset  and  compensate  the  pseudo-range  measure¬ 
ments  with  this  measured  offset.  The  present  Collins  design 
models  the  response  of  each  non-coherent  code  loop  to  the 
filter  feedback  in  the  rate  aiding  signal  and  subtracts  the 
modeled  response  from  the  pseudo-range  measurements  as  shown 
in  Figure  2.  Rather  than  model  the  code  loop  response,  it 
is  possible  to  measure  the  code  loop  response.  The  code 
tracking  loop  operates  on  a  noisy  error  signal  ECODEL.  The 
average  value  of  this  noisy  signal,  say  over  a  5  sec  interval, 
is  a  smoother  measure  of  the  tracking  loop  error.  An 
assumption  must  be  made  about  the  tracking  loop  gain  to 
convert  this  measurement  to  pseudo-range  units.  The  loop- 
error  measurement  is  then  subtracted  from  the  pseudo-range 
measurement  that  comes  from  the  code  offset  command. 


\ 
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An  advantage  of  this  approach  over  the  current  Collins 
approach  might  be  that  direct  measurements  are  more  accurate 
than  the  math  modeling  approach.  Furthermore,  loop  transients 
due  to  noise  are  directly  observed  and  removed  from  the 
pseudo-range  measurements. 

Note  a  consequence  of  removing  the  long-correlation-time 
code  tracking  loop  error  from  the  pseudo  range  measurements 
will  be  to  introduce  a  higher  noise  level  into  the  individual 
measurements.  However,  it  probably  can  be  shown  that  the 
noise  spectral  density  seen  by  the  Kalman  filter  remains  the 
same. 

One  implementation  of  this  approach  would  involve  intro¬ 
ducing  error  accumulation  equations  for  each  channel  in  the 
receiver  computer  (analogous  to  the  delta  range  accumulation 
equations) .  These  integrals  of  the  code  loop  error  signals 
would  be  sampled  by  the  navigation  computer  at  the  measure¬ 
ment  times  (every  five  sec).  A  back  difference  over  the 
last  5  sec  would  yield  the  average  error. 

A  more  detailed  discussion  of  measuring  code  loop  error 
statistics  is  given  in  the  Appendix  of  Ref.  [<  ]  . 


2.5.2  Recommendations  and  Status 

The  suggestion  that  the  filter  feedback  limiter  be  used 
in  the  non-coherent  mode  was  made  to  Dick  Carroll  of  Collins 
by  telephone  on  2  August  1977.  The  additional  suggestions 
concerning  reduced  INS-control  gains  and  concerning  measured- 
code-  loop-error  compensation  were  made  to  Dick  Carroll  by 
telephone  today  (16  September  1977).  It  is  now  quite  late 
in  the  GDM  software  development  schedule.  Dick  indicates  it 
is  unlikely  that  further  changes  can  be  made  in  the  software 
unless  the  change  requirement  is  quite  urgent. 

My  current  recommendations  to  the  AFAL  and  Collins  on 
this  stability  problem  are: 

1.  Allow  the  limiter  to  run  in  the  non-coherent  mode. 

It  will  not  hurt  and  it  might  help. 

2.  Continue  linear  stability  analyses  of  the  vertical 
and  horizontal  channels  of  the  GDM.  These  should 
explore  stability  at  higher  quasi-static  Kalman 
gains . 

3.  Examine  the  stability  improvement  with  reduced  INS 
control  gains. 


4.  Implement  now  in  the  receiver-computer  software 
an  appropriate  set  of  tracking  loop  statistics 
equations,  with  results  delivered  to  the  naviga¬ 
tion  computer  interface,  and  to  the  flight  recorded 
data . 


With  these  analyses  and  immediate  software  changes, 

Collins  can  later  implement  in  the  navigation  computer 
either  the  reduced  INS-control  gains  idea  or  the  measured- 
code-loop-error  compensation  idea  or  both,  should  the  current 
design  prove  to  be  still  unstable. 


2.6  Stability  of  Alternate  Designs  for  Rate  Aiding  of  Non-Coherent  Mode  of 

GPS  Receiver 

The  results  of  this  study  effort  have  been  published  in  a  separate  docu¬ 
ment,  "Stability  of  Alternate  Designs  for  Rate  Aiding  of  Non-Coherent  Mode  of 
a  GPS  Receiver",  by  William  S.  Widnall,  dated  25  September  1978  [7],  This 
section  comprises  excerpts  from  Sections  1.1  and  7.0  of  that  report. 

2.6.1  Anti-Jamming  Characteristics  of  the  GPS  GDM 

The  anti-jamming  characteristics  of  the  GPS/GDM  are  summarized  in  Ref.  [8]. 
A  phased-array  antenna  is  used  to  provide  high  gain  in  the  directions  of  four 
GPS  satellites  and  simultaneous  low  gain  for  jammer  sources  out  of  the  main 
lobes.  This  provides  15  db  of  anti-jamming  margin  compared  with  the  performance 
with  a  conventional  low  gain  antenna.  Inertial  navigation  system  (INS)  data 
is  used  to  rate  aid  the  GPS  receiver.  The  aiding  permits  narrower  bandwidth 
tracking  loops  in  the  GPS  receiver.  This  provides  an  additional  10  to  12  db 
of  anti-jamming  margin  compared  with  the  performance  of  an  unaided  wide  band¬ 
width  receiver.  In  the  absence  of  jamming,  the  normal  tracking  of  each 
satellite  signal  includes  a  phase-locked  loop  (Costas  loop)  tracking  of  the 
carrier  and  non-coherent  delay  locked  loop  (NDll)  tracking  of  the  pseudo¬ 
random  code  modulation.  As  jamming  power  increases,  eventually  a  Costas  loop 
loses  lock.  The  GDM  is  designed  to  continue  tracking  after  loss  of  carrier 
lock,  using  only  the  non-coherent  code  tracking.  The  non-coherent  code  loop 
tracking  has  about  8  db  more  jamming  tolerance  than  the  carrier  loop. 

2.6.2  Conclusions  and  Recommendations 

The  stability  of  alternate  designs  for  rate  aiding  the  non-coherent 
GDM  GPS  receiver  has  been  explored. 

A  baseline  design  was  defined  to  include  the  suboptimal  Kalman  filter 
(without  the  stabilization  compensation)  and  the  maximum  rate  error  reset. 
Numerical  computation  of  the  poles  of  this  system  confirm  the  results  previously 
reported  by  Collins  personnel,  namely  the  system  is  unstable  when  the  Kalman 
cut-off  frequency  approaches  the  code  tracking  loop  noise  bandwidth.  In 
the  single  axis  vertical  channel  example  and  with  the  code  loop  noise  band¬ 
width  of  0.01  Hz,  the  system  became  unstable  for  Kalman  filter  cut-off 
frequency  somewhere  between  .01  and  .0316  rad/sec  (.0016  and  .005  Hz). 
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The  GDM  design,  as  documented  and  discussed  in  Refs. [4]  . [  5]  ,  and  (9], 
is  similar  to  the  baseline  design  but  with  the  addition  of  stabilization 
compensation.  The  stabilization  compensation  does  improve  the  stability  of 
the  system,  provided  the  model  in  the  compensation  is  tuned  to  match  the 
tracking  loop  dynamics  in  its  lowest-loop-gain  condition.  One  defect  in  the 
present  compensation  design  is  that  there  exists  the  possibility  of  a  static 
altitude  error  due  to  a  non-zero  steady  state  variable  in  the  compensation. 
Fortunately  this  defect  can  be  eliminated  with  a  simple  software  change 
in  the  GDM  data  processor. 

One  alternate  approach  to  improving  the  stability  of  the  system  is  to 
significantly  reduce  the  rate  at  which  the  estimated  INS  errors  are  controlled. 
In  the  vertical  channel  example  it  was  demonstrated  that  with  control  gains 
of  .005  sec’1  (200  sec  control  time  constant)  the  system  is  stable  for 
Kalman  cut-off  frequency  more  than  a  factor  of  ten  faster  than  the  tolerable 
filter  frequency  in  the  baseline  design. 

A  different  approach  to  improving  the  stability  is  to  eliminate  the 
code  tracking  error  from  the  pseudorange  measurements.  If  this  can  be  done, 
the  pseudorange  measurements  have  uncorrelated  random  error,  and  the  stability 
problem  is  eliminated.  The  poles  of  the  system  include  tracking  loop  poles, 
regulated  INS  error  poles,  and  Kalman  filter  error  poles.  Only  the  placement 
of  the  Kalman  filter  poles  depends  on  the  filter  cut-off  frequency.  All 
poles  of  the  system  are  stable,  both  for  high-rate  and  low-rate  control  gains. 

The  principles  involved  in  eliminating  code  tracking  error  from  the 
pseudorange  measurements  were  discussed.  One  key  technical  problem  is  the 
estimation  of  the  detector  gain,  which  is  a  function  of  the  signal  power. 

The  Magnavox  method  of  estimating  detector  gain  was  discussed.  It  appears 
that  the  Magnavox  method  cannot  be  used  in  the  highest  jamming  environment 
because  of  the  excessively  long  time  required  to  estimate  the  signal  strength. 
Perhaps  an  alternate  method  of  calculating  detector  gain  can  be  proposed  that 
overcomes  this  problem.  For  example,  the  signal  strength  in  the  receiver 
preamplifier  could  be  assumed  known,  based  on  assumed  satellite  power,  path 
losses,  antenna  gain,  and  so  forth.  The  modification  of  the  signal  in  the 
receiver  due  to  automatic  gain  control,  and  so  forth,  perhaps  can  be  calcu¬ 
lated  as  a  function  of  available  receiver  variables. 


We  recommend  the  reduced-control -gain  design  for  immediate  implementa¬ 
tion  in  the  GDM.  The  required  modifications  to  the  GDM  software  appear  easy 
to  implement.  The  more  extensive  software  associated  with  the  stabilization 
compensation  can  be  deleted.  The  reduced-control -gain  design  also  has  the 
fundamental  advantage  that  the  stability  improvement  provided  is  not 
dependent  on  the  tracking  loop  bandwidth  being  some  exact  value. 

To  eliminate  code  tracking  error  from  the  pseudorange  measurements, 
much  more  extensive  software  changes  would  be  required  in  the  GDM.  Signifi¬ 
cant  logic  and  calculations  would  have  to  be  added  to  the  software  in  the 
receiver  controller  computer.  In  spite  of  the  lack  of  clear  approach  for 
the  high  janwing  case  plus  the  significant  software  changes  required,  we 
recommend  that  this  approach  be  developed  for  advanced  versions  of  the  GDM . 

Tnis  approach  with  its  decorrelated  measurements  and  with  its  measured  noise 
variance  can  lead  to  improved  navigation  accuracy,  because  the  Kalman  filter 

can  accurately  model  the  measurements  and  their  time-varying  statistics. 

The  numerical  examples  in  this  report  have  been  carried  out  for  a 
nominal  code  loop  noise  bandwidth  of  .01  Hz.  The  present  GDM  design  employs 
a  bandwidth  of  .03  Hz.  The  more  stable  alternate  designs  evaluated  in  this 
report  remove  stability  from  the  design  considerations  that  constrain  the 
minimum  bandwidth.  Accordingly  if  the  quality  of  the  inertial  system  and  of 
the  receiver  clock  are  sufficiently  excellent,  the  noise  bandwidth  can  be 
reduced.  The  anti-jamming  characteri sties  will  be  improved. 
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SECTION  III 

VERTICAL  CHANNEL  ANALYSIS  AND  SIMULATION 


3 . 1  Chapter  Summary 

Intermetrics  has  reviewed  the  AFAL  Integrated  GPS/Inertial 
(IGI)  Simulator,  designed  and  implemented  alternate  vertical 
channel  models,  and  demonstrated  satisfactory  performance  with 
the  revised  models.  Specific  techru.ca_  issures  tdiat  have  been  analyzed 
in  depth  are  the  following: 

i)  ider tif ication  and  elimination  of  problems  causing  poor  vex tical- 
channel  performance  in  original  simulator,  and  demnnst.rat.ior  o*- 
proper  performance  for  lcw-dvnnric  C5  mission; 

ii)  ccrrrarison  of  simulated  performance  of  three  vertical  channel  filter 
designs  for  hi oh-dynamic  F4  mission. 


Results  of  these  analyses  are  presented  in  Sections  3 . 2  and  3.3. 


3.2  C5\  G\ S/Inertial  Simulation  Results 


Under  Task  2  of  the  AFAL  GPS  Software  Support  Contract, 
the  AFAL  IGI  (Integrated  GPS  Inertial)  Simulator  has  been 
modified  to  correct  certain  difficulties  experienced  by  AFAL 
personnel  with  .he  simulated  vertical  channel  performance. 

To  obtain  initial  results,  Myers  and  Butler  found  it  necessary 
to  zero  an  important  source  of  altimeter  error,  the  altimeter 
scale  factor  error.  These  difficulties  and  the  initial  results 
were  reported  in  Ref.  [10). 

Intermetrics  has  made  several  revisions  to  the  IGI  simula¬ 
tor  and  has  eliminated  the  problems  causing  poor  vertical 
channel  performance.  The  modified  IGI  simulator  was  delivered 
to  the  AFAL  in  May  1977.  An  analysis  report  comparing  the 
performance  of  three  alternate  Kalman  filter  vertical  channel 
designs  will  appear  shortly.  However,  the  results  in  this 
report  are  for  a  simulated  high-dynamic  F4  mission.  Maior  Myers 
requested  that  we  also  run  one  low-dynamic  C5  case,  similar  to 
the  case  of  Ref. (10)  ,  to  demonstrate  conclusively  that  we  have 
eliminated  the  difficulties.  We  have  run  such  a  case.  This 
memo  presents  the  results. 


This  case  is  similar  to  that  of  Ref.[iO]  in  that  it  has 
the  same  C5  trajectory  and  has  a  Kalman  filter  whose  only  model 
for  altimeter  error  is  a  single  scale  factor  error  state.  The 
case  differs  in  many  details,  including  truth  state  error  models, 
truth  state  initial  conditions,  and  Kalman  filter  noise 
covariance  modeling.  It  is  beyond  the  scope  of  this  memo  to 
list  all  of  these  differences.  Complete  model  descriptions 
are  included  in  the  Task  2  report.  The  two  changes  which  are 
perhaps  of  the  greatest  significance  in  obtaining  the  good 
vertical  channel  performance  are:  1)  changing  the  Kalman  filter 
scale  factor  error  state  from  a  random  constant  to  a  random  walk, 
and  using  the  spectral  density  of  the  noise  of  this  random  walk 
to  model  the  varying  effect  of  the  altimeter  zero-setting  error 
when  the  altitude  is  changing;  2)  correcting  an  error  in  the 
simulated  GPS  pseudo-range  rate  measurements  associated  with  the 
clock  frequency  error  model. 

Simulation  results  for  the  C5  case  are  shown  in  the  enclosed 
figures.  The  position  and  velocity  errors  of  the  baro-iner tial 
navigator  (unaided  by  GPS  measurements)  are  shown  in  Figures  4 
and  5.  The  errors  in  the  best  estimates  of  position,  velocity, 
attitude,  user  clock  phase,  and  frequency  are  shown  in  Figures  6 
through  9.  The  error  in  the  estimate  of  the  effective  altimeter 
scale  factor  is  shown  in  Figure  10.  These  plots  of  estimation 
error  also  include  the  Kalman  filter  computed  uncertainty  in  the 
estimate  (which  is  the  square  root  of  the  appropriate  element 
of  the  covariance  matrix) . 


One  conclusion  from  these  results  is  that  the  vertical 
channel  performance  is  satisfactory.  The  errors  in  the  estimates 
of  altitude,  vertical  velocity,  and  altimeter  scale  factor  error 
are  generally  within  the  filter  computed  one-sigma  uncertainties. 
The  level  of  the  errors  in  altitude  and  vertical  velocity  are 
consistent  with  the  authors'  experience  of  the  accuracy 
achievable  with  GPS-inertial  systems. 
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The  large  peaking  of  errors  and  computed  uncertainties  at 
230  min  has  been  traced  to  an  error  in  the  IGI  simulator.  The 
error  has  been  found  in  the  satellite  selection  algorithm  coding 
(subroutine  OPTSEL) .  The  coding  causes  an  erroneous  comparison 
of  the  GDOP 1 s  of  various  satellite  groups  which  are  in  view  at  a 
given  satellite  selection  time  with  the  GDOP  of  the  most 
favorable  satellite  group  at  a  previous  satellite  selection  time. 
If  the  GDOPs  of  all  combinations  (of  four)  of  the  in-view 
satellite  set  at  the  given  satellite  selection  time  is  greater 
than  that  of  the  satellite  group  at  the  previous  satellite 
selection  time,  then  the  old  satellite  group  is  retained.  This 
error  causes  the  possible  use  by  the  measurement  updating 
sequence  of  satellites  that  are  actually  not  in  view  at  the 
measurement  time.  The  consequence  of  which  is  degraded  GPS 
navigation  accuracy. 

Figure  6  shows  the  position  errors  for  the  C5-A  mission. 

After  about  85  min  of  flight,  a  group  of  satellites  is  selected 
which  at  that  time  has  a  very  low  value  for  GDOP.  However,  this 
set  of  satellites  was  maintained  for  the  remainder  of  the 
mission  even  though  one  or  more  of  these  satellites  were  no 
longer  in  view,  and  the  GDOP  of  this  satellite  group  is  probably 
no  longer  optimum  shortly  after  85  min.  The  disposition  of 
this  satellite  group  appears  to  pass  through  some  sort  of  singular 
configuration  at  around  230  min.  Even  though  some  of  these 
satellites  are  not  visible,  the  IGI  simulator  incorporated 
measurements  from  them  as  though  they  were  visible. 


Intermetrics  has  designed  a  change  to  the  satellite  selection 
algorithm,  and  this  change  will  be  incorporated  and  tested 
during  our  Task  3  work. 


A  comparison  of  the  enclosed  figures  with  the  results 
presented  in  Ref.  [10]  exposes  the  effect  of  some  of  the  changes 
we  ftave  made  to  the  IGI  simulator.  Eliminating  the  driving 
noise  on  the  longitude  and  latitude  error  states  has  eliminated 
the  large  growth  in  position  error  covariance  between  measure¬ 
ments.  Significantly  reducing  the  driving  noises  during 
unaccelerated  flight  on  the  velocity  error  states  and  the 
attitude  error  states  has  reduced  significantly  the  growth  in 
velocity  and  attitude  error  covariance  between  measurements. 

Note  the  order-of-magnitude  lower  azimuth  error  covariance. 


Evidence  of 
in  the  Ref.  [10] 
hour  of  the  Ref. 


the  satellite  selection  error  is  not  obvious 
results,  although  the  divergence  ir.  the  last 
[10]  results  may  be  related  to  this  error. 


■jWil 
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Figure  9:  Clock  Phase  and  Frequency  Estimation  Errors 


3-9 


'--.0.  00 


t  00 .  00  1S0.00  ? 00 . 00 

T  IMUMINS) 


,  '10.  00 


'00.00  JS0.00  ‘100.00 


3 . 3  Comparison  of  Three  Vertical  Channel  Filter  Designs 

The  results  of  this  Intermetrics  study  have  been  published 
in  a  separate  report,  "Comparison  of  Three  Vertical  Channel 
Designs  for  Integrated  GPS/Inertial  Navigation  Systems",  by 
William  S.  Widnall  and  Prasun  K.  Sinha,  dated  27  July  1977  [13]. 
This  section  comprises  excerpts  from  Sections  1.3  and  5  of  that 
report . 

The  IGI  Simulator  is  used  to  evaluate  alternate 
Kalman  filter  vertical  channel  designs.  Section  2 
summarizes  the  truth  model  provided  by  the  simulator. 

The  error  models  of  the  baro-inertial  navigator  and  of 
the  GPS  measurements  are  presented.  A  F4  aircraft  tra¬ 
jectory  has  been  selected  to  drive  the  error  models. 

This  trajectory  is  also  described  in  Section  2.  The 
baro-inertial  navigation  errors  produced  by  the  assumed 
sources  of  error  and  by  the  assumed  trajectory  are  plotted 
and  presented. 

Section  3  presents  a  basic  recursive  (Kalman) 
filter  for  blending  the  inertial  navigation  and  GPS 
measurement  data.  Then  three  alternate  vertical  channel 


filter 

designs  are  presented: 

1. 

Filter  A  has  two  states  representing  the  altimeter 
sources  of  error,  an  altimeter  bias  state  and  an 
altimeter  scale  factor  error  state; 

2. 

Filter  B  has  a  single  altimeter  error 
altimeter  bias  state; 

state,  an 

3. 

Filter  C  has  a  single  altimeter  error 
scale  factor  error  state. 

state,  a 

Appropriate  expressions  are  developed  for  the  spectral 
densities  of  the  assumed  noises  driving  these  states. 
These  noises  model  the  important  sources  of  error  that 
have  not  been  included  as  states. 

Section  4  presents  the  results  of  running  each  of 
these  three  filter  designs  in  the  IGI  simulator  with  the 
same  truth  model  for  the  errors  and  with  the  same  F4 
trajectory.  The  comparative  performance  is  discussed. 

are  presented  in  Section  5. 
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Conclusions 


The  Integrated  GPS/Inertial  ( IGI ) Simulator  has 
been  utilized  to  explore  several  design  issues 
associated  with  the  vertical  channel  of  a  GPS/baro/ 
inertial  navigation  system.  The  primary  issues 
explored  were  associated  with  the  modeling  of 
barometric  altimeter  error  in  the  Kalman  filter. 

Should  two-state  variables  be  used  in  the  filter  to 
model  altimeter  error,  or  is  one  sufficient?  If  only 
one  state  is  used,  should  it  be  a  bias-like  error 
model  or  should  it  be  a  scale-factor  error  model? 

How  can  an  assumed  white  noise  driving  a  single  error 
state  be  used  to  model  the  effect  of  other  sources 
of  error? 

The  assumed  navigation  system  is  comprised  of: 
a  local-level  wander  azimuth  inertial  navigation 
system  with  associated  barometric  altimeter  for 
stabilizing  the  vertical  channel,  a  GPS  pseudo  range 
and  range-rate  receiver,  and  a  navigation  computer 
hosting  a  Kalman  filter  to  integrate  the  baro/inertial 
and  GPS  data. 

The  error  model  in  the  simulator  has  fifty-four 
states  representing  the  inertial  navigation  position, 
velocity,  and  attitude  errors,  the  gyro  sources  of 
error,  the  accelerometer  sources  of  error,  the  gravity 
deflections  and  anomaly,  the  barometric  altimeter 
sources  of  error,  and  the  GPS  receiver  clock  phase  and 
frequency  errors.  Significant  sources  of  barometric 
altimeter  error  included  are  the  zero-setting  error, 
the  scale  factor  error,  the  static  pressure  measure¬ 
ment  error,  and  the  altimeter  lag. 

The  simulated  flight  path  is  representative  of 
a  F-4  aircraft  tactical  mission  profile.  There  are 
periods  of  straight  and  level  flight,  dives  and  climbs, 
and  high-g  evasive  maneuvering.  There  is  a  seven 
minute  period  during  which  jamming  prevents  the  use 
of  GPS  measurements.  During  this  period,  the  aircraft 
dives  15,000  feet  to  a  hypothetical  target  area,  then 
climbs  back  to  altitude. 

Three  Kalman  filter  vertical  channel  designs  were 
evaluated.  Filter  A  has  seventeen  states  and  filters 
B  and  C  have  sixteen  states.  The  first  fifteen  states 
are  common  to  all  three  filters.  These  are  the  states 
modeling  INS  position,  velocity,  and  attitude  errors 
(9) ;  receiver  clock  phase  and  frequency  errors  (2) ; 
gyro  drift  rates  (3) ;  and  vertical  acceleration  error 
(1) .  The  modeling  of  these  fifteen  states  is  similar 
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to  that  in  the  Kalman  filter  in  the  original  IGI  simu¬ 
lator,  except  that  maneuver-dependent  variances  of  the 
driving  noises  have  been  introduced  to  model  the  effects 
of  accelerometer  scale  factor  errors  and  input  axis 
misalignments  and  to  model  the  effects  of  gyro  g-sensi- 
tive  drift  rates. 

Filter  A  has  two  states  representing  the  altimeter 
sources  of  error:  one  state  a  bias  error  and  the  other 
state  a  scale  factor  error.  Filter  B  has  only  one 
altimeter  error  state,  and  it  is  a  random  walk  bias 
model.  Filter  C  also  has  only  one  altimeter  error 
state,  but  it  is  a  random  walk  scale  factor  error 
model.  The  single-state  error  models  have  variances 
for  their  driving  noises  that  are  functions  of  the 
altitude  changes. 

Analysis  of  the  alternate  designs,  including  the 
comparative  simulation  results  has  led  to  several 
observations  and  conclusions.  The  three  filter  designs 
provide  essentially  identical  navigation  performance 
when  GPS  measurements  are  available.  The  differences 
in  performance  arise  during  loss  of  signal. 

Filter  A  with  its  two-state  altimeter  error  model 
provides  the  best  vertical  channel  performance  during 
loss  of  signal.  After  processing  external  (GPS)  mea¬ 
surements  during  descents  and  climbs,  the  filter  is  able 
to  calibrate  both  the  zero-setting  error  and  the  scale 
factor  error.  This  leads  to  improved  vertical  channel 
performance  during  the  subsequent  dive  and  climb  in  the 
period  of  no  external  measurements  (jamming) .  In  the 
jamming  period,  peak  altitude  error  was  400  feet  and 
the  largest  vertical  velocity  error  was  about  two  feet 
per  second. 

Filter  B  with  its  single-state  altimeter  bias  model 
converges  to  a  correct  estimate  of  the  combined  alti¬ 
meter  error  while  processing  external  measurements. 
During  the  jamming  period,  the  bias  estimate  holds 
constant.  In  the  dives  and  climbs  during  the 
jamming  period,  the  true  altimeter  scale  factor  error 
causes  shifts  in  the  altimeter  error,  which  cannot  be 
compensated  by  filter  B.  The  simulation  results 
exhibited  altitude  errors  from  -340  to  680  feet  and 
a  peak  vertical  velocity  error  of  about  3  feet/sec. 

Filter  C  with  its  single-state  altimeter  scale 
factor  model  has  the  worst  vertical  channel  perfor¬ 
mance.  The  estimate  of  the  effective  scale  factor 


error  converges  to  a  correct  value  while  processing 
external  measurements.  This  effective  scale  factor 
error  estimate  when  multiplied  by  the  current  altitude 
gives  a  value  for  baro  altitude  error  that  matches 
the  total  baro  altitude  error  from  the  several  sources 
of  error.  During  the  jamming  period,  the  effective 
scale  factor  error  estimate  holds  constant.  The 
accuracy  of  the  baro  altitude  error  estimate,  during 
dives  and  climbs  in  this  jamming  period,  depends  on 
the  difference  between  the  estimated  effective  scale 
factor  error  and  the  true  scale  factor  error.  In  the 
simulation  case,  the  estimated  scale  factor  error  was 
0.08  and  the  true  scale  factor  error  was  0.03.  The 
difference  of  0.05  provided  a  strong  excitation  to 
the  errors  in  the  filter  estimates  of  vertical 
velocity  and  altitude.  Altitude  errors  ranged  from 
770  feet  to  -895  feet  and  the  peak  vertical  velocity 
error  was  larger  than  4  feet/sec.  The  vertical  velo¬ 
city  estimation  errors  of  the  filter  were  actually 
larger  than  the  vertical  velocity  errors  of  the  no¬ 
filter  baro-inertial  system.  If  the  period  of  jamming 
had  started  at  a  higher  altitude  or  had  the  zero  set¬ 
ting  error  been  smaller,  then  the  difference  between 
the  effective  scale  factor  error  and  the  true  scale 
factor  error  would  have  been  smaller  and  the  subse¬ 
quent  vertical  channel  errors  during  the  dives  and 
climbs  would  have  been  smaller. 

A  filter  similar  to  filter  C  was  evaluated  by 
Myers  and  Butler.  It  also  had  a  single-state  alti¬ 
meter  error  model,  which  was  a  scale  factor  error. 
However,  this  state  was  modeled  as  a  random  constant 
rather  than  a  random  walk.  In  the  simulation  results, 
while  processing  GPS  measurements  (no  jamming)  the 
filter  diverged  from  correct  estimates  of  vertical 
velocity,  altitude,  and  even  latitude  and  longitude. 
While  we  have  not  attempted  to  re-run  this  exact 
design,  we  believe  the  design  diverged  because  of 
the  random  constant  model.  With  such  a  model,  the 
filter  will  converge  to  a  fixed  estimate  of  the 
effective  scale  factor  error  and  the  computed  un¬ 
certainty  will  go  to  zero.  With  complete  confidence 
in  its  calibrated  baro  altimeter  data,  and  because 
of  the  closed  baro-inertial  loop,  the  filter  computed 
uncertainty  in  the  estimate  of  altitude  also  goes 
to  zero.  The  filter  then  ignores  current  external 
(GPS)  measurements  as  far  as  altitude  updating  is 
concerned.  If  there  is  actually  a  large  altitude 
estimation  error,  the  GPS  measurement  residuals 
must  be  put  somewhere,  and  this  leads  to  forced 


errors  in  the  estimates  of  latitude,  longitude, 
and  clock  phase.  The  filter  C  evaluated  in  this 
report  avoids  these  performance  difficulties  by 
using  a  random  walk  error  model.  The  variance 
assigned  to  the  driving  noise  is  sufficient  to  pre¬ 
vent  the  filter  from  becoming  over  confident. 

The  other  estimations  errors  of  the  three  Kalman 
filter  designs  were  also  analyzed.  The  horizontal 
position  and  velocity  errors,  the  attitude  errors, 
and  the  clock  phase  and  frequency  errors  for  the 
three  cases  were  essentially  identical  including 
during  the  period  of  jamming.  The  differences  in 
the  vertical  channel  designs  produced  no  significant 
differences  in  these  other  errors. 

The  three  filters  exhibited  good  self  consis¬ 
tency.  The  filter  computed  uncertainties  were  general¬ 
ly  in  agreement  with  the  estimation  errors.  An  excep¬ 
tion  was  the  north  position  error,  which  had  a  bias 
value  exceeding  the  computed  uncertainty.  Changes 
to  the  measurement  processing  are  proposed  which 
should  eliminate  the  bias.  The  horizontal  components 
of  attitude  error  also  have  values  exceeding  the  com¬ 
puted  uncertainties.  These  biases  are  the  unobservable 
tips  due  to  various  sources  of  horizontal  acceleration 
measurement  error.  The  maneuver  dependent  driving 
noises  for  the  velocity  error  states,  the  attitude  error 
states,  and  the  baro  altitude  error  state  help  provide 
the  desired  consistent  performance. 


SECT I CM  IV 

IMPROVED  IGI  SIMULATOR  MODELS 


4 . 1  Chapter  Summary 

Intermetrics  has  upgraded  the  AFAL  Integrated  GPS/Inertial 
(IGI)  Simulation  Program.  The  new  version  of  the  IGI  Simulator 
implements  GPS  pseudorange  and  delta-pseudorame  plus  barcmetric 
altimeter  error  models  whose  fidelity  is  comparable  to  that  of 
the  existing  inertial  navigation  system  (INS)  error  models. 
Emphasis  has  been  placed  on  the  following  technical  areas; 

i)  Upgraded  barometric  altimeter  error  models; 

ii)  Upgraded  GPS  pseudorange  and  delta-pseudorange  error 
models ; 

iii)  Program  structural  changes. 

These  areas  are  discussed  further  in  subsection  4.2. 


4 . 2  Revised  IGI  Simulator  Computer  Program 

Results  of  Intermetrics'  effort  on  upgrading  the  IGI 
Simulator  have  been  published  in  a  separate  document,  "Integrat¬ 
ed  GPS/Inertial  Simulator  Computer  Program,"  by  Prasun  K.  Sinha, 
dated  26  August  1977  [ll] .  The  following  paragraphs  and  figure 
are  excerpted  from  Sections  1  and  2.1  of  that  document. 


The  Air  Force  Avionics  Laboratory  (AFAL)  is  engaged 
in  developing  a  Generalized  Development  Model  (GDM)  of 
the  Global  Positioning  System  (GPS)  user  equipment.  To 
supplement  the  GDM  and  GPS  evaluator  developments,  a 
computer  program  has  been  developed  for  simulating 
Integrated  GPS/Inertial  (IGI)  aircraft  navigation  systems. 
The  IGI  Simulator  is  an  analytical  tool  which  can  be 
used  to  perform  system  analyses,  equipment  evaluation 
studies  and  to  aid  in  the  establishment  of  specifications 
for  IGI  navigation  systems.  This  report  documents  the 
August  1977  version  of  the  IGI  Simulator  and  is  intended 
as  a  user's  guide. 
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The  IGI  Simulator  is  described  in  Section  2  of  this 
report.  Section  2  presents  the  basic  equations  for 
propagation  of  the  states  of  the  simulation  and  filter 
models.  Specific  models  for  simulating  the  Litton  CAINS 
LN-15  Inertial/GFS  and  a  Hainan  filter  mechani zat ion  are 
also  presented.  Section  2  concludes  with  a  brief  dis¬ 
cussion  of  the  nature  of  the  GTS  measurements  and  a 
presentation  of  the  GPS  measurement  processing  equations. 
Section  3  describes  the  inputs  to  the  Simulator  and 
presents  a  sample  input  file.  Section  4  describes  the 
outputs  from  the  Simulator  and  presents  a  sample  of  the 
printout  generated  using  the  sample  input  file  of  Section  3. 
While  not  directly  part  of  the  IGI  Simulator  outputs, 

Section  4  presents  samples  of  plots  generated  by  the  data 
output  by  the  simulator  to  a  plot  file.  A  complete  listing 
of  the  August  1977  version  of  the  IGI  Simulator  is  included 
in  Appendix  A.  Appendix  B  of  this  report  contains  a 
derivation  of  the  GPS  measurement  gradient  vectors  used  in 
the  IGI  Simulator. 

The  August  1977  version  of  the  IGI  simulator  uses 
a  direct  linear  simulation  approach  I !  Oj in  which  the 
differential  equations  representing  the  Inertial  Navi¬ 
gation  System  (INS)  indications  of  position,  and 
velocity  as  well  as  the  INS  attitude  errors  are  linearized 
about  a  precomputed  reference  flight  tra jectoi y [ i j].  The 
INS  indicated  data  computed  in  this  manner  is  then 
processed  together  with  GPS  pseudo-range  and  delta  range 
measurements  in  a  linearized  Kalman  filter  to  obtain 
estimates  of  errors  in  the  INS  indicated  position, 
velocity  and  other  sources  of  error  mechanized  in  the 
filter.  The  user's  navigation  parameters  are  then  updated 
using  these  error  est i mates.  figure  11  shows  a  I unct ional 
diagram  oi  the  basic  structure  ot  the  TGI  simulator. 


The  main  monitor  program  IGISIM,  sequences  the  IGI 
simulator  through  the  various  phases  shown  in  Figure  11. 
All  program  initialization  that  is  independent  ot 
the  simulation  and  filter  error  models  is  carried  out 
in  subroutine  GPSINIT.  The  simulation  model  equations 
and  the  filter  error  model  equations  are  integrated  in 
subroutine  STATEUD.  The  GPS  pseudo-range  and  delta 
range  measurements  are  incorporated  in  subroutine  MEASUD. 
Simulation  outputs  occur  in  two  forms:  (i)  printed  out¬ 

put  via  subroutine  PRINTS,  and  (ii)  output  for  plotting 
purposes  which  is  transferred  to  a  plot  file  via 
subroutine  PLDATA.  The  true  reference  trajectory  data 
which  drives  the  INS  error  model  is  precomputed  by  a 
separate  program  PROFGEN  [l  .>].  Besides  driving  the  error 
model,  the  true  reference  trajectory  data  is  also  used 
to  construct  simulated  true  pseudo-range  and  delta  range 
measurements . 


SECTION  V 

INTEGRATED  GPS/STRAPDOWN  PERFORMANCE 


5 . 1  Chapter  Summary 

Intermetrics  has  added  a  strapdown  inertial  simulation 
capability  to  the  IGI  simulator.  The  error  model  implemented  is 
that  of  the  Honeywell  SIGN-III  baro-inertial  navigator.  This 
error  model  was  also  derived  and  documented  in  Ref. [14] .  The 
structure  of  the  error  model  is  quite  general,  so  users  of  this 
strapdown  version  of  the  IGI.  simulator  can  simulate  many  other 
strapdown  systems  simply  by  altering  the  values  assumed  for  the 
individual  sources  of  error. 

In  the  process  of  checking  out  the  strapdown  error  model 
in  the  IGI  simulator,  a  "stress-test"  was  conducted  using  a 
high-dynamic  F4  aircraft  trajectory.  Analysis  indicated  that 
the  simulation  indeed  was  giving  correct  answers,  and  the  large 
navigation  errors  observed  were  explainable  by  a  few  key  sources 
of  angular  velocity  error. 

Strapdown  inertial  system  characteristics  are  described 
in  Section  5.2.  The  integrated  GPS/  Strapdown  Inertial  Simul¬ 
ator  and  the  simulated  performance  results  are  described 
further  in  Sections  5.3  and  5.4,  respectively. 


5  •  2  Strapdown  Inertial  Navigation  Systems 

This  section  is  excerpted  from  Section  1.2  of  Ref.  [15 1 
by  Prasun  K. Sinha  and  William  S.  Widnall. 

Strapdown  Inertial  Navigation  Systems  are  characterized 
by  having  all  inertial  instruments  mounted  directly  on  to  the 
vehicle  for  which  the  navigation  function  is  to  be  provided. 

The  task  of  physical  instrumentation  of  reference  frames  by 
a  series  of  gimbals  is  thus  replaced  by  on-board  computation 
of  the  vehicle  orientation  with  respect  to  a  reference  frame, 
based  on  information  from  the  vehicle-mounted  gyros. 

Strapdown  systems  therefore  requrie  a  more  extensive  computer, 
but  may  have  advantages  over  gimballed  systems  in  terms  of 
power  requirements,  packaging  flexibility,  ease  of  maintenance, 
and  perhaps  cost.  A  major  disadvantage  of  strapdown  systems 
vis-a-vis  the  gimballed  systems  is  that  they  are  less  accurate. 


\ 
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The  primary  cause  of  the  strapdown  system's  inaccuracy 
is  the  fact  that  the  inertial  angular  velocity  of  the  Inertial 
Measurement  Unit  (IMU)  frame  is  equal  to  the  inertial 
angular  velocity  of  the  vehicle.  The  vehicle  mounted 
instruments  can  thus  be  subjected  to  a  relatively  harsh 
dynamic  environment  since  there  is  no  gimballed  structure 
to  isolate  the  sensors  from  the  angular  motion  of  the  vehicle. 
Because  of  these  environmental  considerations,  the  instruments 
are  required  to  have  a  high  dynamic  range  which  usually  results 
in  a  compromise  in  accuracy. 


5.1  In  tec,  rated  GPS/Strapdown  Inertial  Simulator 

Intermetrics  has  produced  a  second  upgraded  version  of  the 
AFAL  IGI  Simulator  that  models  a  strapdown  inertial  navigation 
system,  its  error  sources,  and  a  representative  GPS/strapdown 
navigation  filter.  This  second  version  of  the  revised  simulator 
is  described  in  a  separate  document,  "Integrated  GPS/Strapdown 
Inertial  Simulator  Computer  Program,"  by  Prasun  K.  Sinha,  dated 
December  1977  [16].  The  following  paragraphs  are  excerpted  from 
Sections  1  and  2.1  of  that  document,  and  pertain  to  the  Decemb¬ 
er  1977  version  of  the  simulator. 

The  IGI  Simulator  is  described  in  Section  2  of  this 
report.  Section  2  presents  the  basic  equations  for 
propagation  of  the  states  of  the  simulation  and  filter 
models.  Specific  models  for  simulating  the  Honeywell 
SIGN-III  Inertial/GPS  and  a  Kalman  filter  mechani za t ion  are 
also  presented.  Section  2  concludes  with  a  brief  dis¬ 
cussion  of  the  nature  of  the  GPS  measurements  and  a 
presentation  of  the  GPS  measurement  processing  equations. 

Section  3  describes  the  inputs  to  the  Simulator  and 
presents  a  sample  input  file.  Section  4  describes  the 
outputs  from  the  Simulator  and  presents  a  sample  of  the 
printout  generated  using  the  sample  input  file  of  Section  3. 

While  not  directly  part  of  the  IGI  Simulator  outputs. 

Section  4  presents  samples  of  plots  generated  by  the  data 
output  by  the  simulator  to  a  plot  file.  A  complete  listing 
of  the  December  1977  version  of  the  IGI  Simulator  is  included 
in  Appendix  A.  Appendix  B  of  this  report  contains  a 
derivation  of  the  GPS  measurement  gradient  vectors  used  in 
the  IGI  Simulator. 

The  fundamental  difference  between  this  December  1977 
version  of  the  IGI  simulator  and  the  August  1977  version  of 
the  IGI  simulator  (which  is  documented  in  Intermetrics  Report 
236,  dated  26  August  1977)  is  that  this  simulator  includes  a 
strapdown  INS  error  model  whereas  the  earlier  simulator 
includes  a  local-level  INS  error  model. 


The  December  1977  version  of  the  IGI  Simulator  uses 
a  direct  linear  simulation  approach UO Jin  which  the 
differential  equations  representing  the  Inertial  Navi¬ 
gation  System  (INS)  indications  of  position,  and  velocity 
as  well  as  the  INS  alignment  variables  are  linearized 
about  a  precomputed  reference  flight  trajectory  1121.  The 
INS  indicated  data  computed  in  this  manner  is  then 
processed  together  with  GPS  pseudo-range  and  delta  pseudo¬ 
range  measurements  in  a  linearized  Kalman  filter  to  obtain 
estimates  of  errors  in  the  INS  indicated  position, 
velocity  and  other  sources  of  error  mechanized  in  the 
filter.  The  user's  navigation  parameters  are  then  updated 
using  these  error  estimates. 


The  main  monitor  program  IGISIM,  sequences  the  IGI 
simulator  through  the  various  phases  shown  in  Figure  11. 

All  program  initialization  that  is  independent  of 
the  simulation  and  filter  error  models  is  carried  out 
in  subroutine  GPSINIT.  The  simulation  model  equations 
and  the  filter  error  model  equations  are  integrated  in 
subroutine  STATEUD.  The  GPS  pseudo-range  and  delta  pseudo¬ 
range  measurements  are  incorporated  in  subroutine  MEASUD. 
Simulation  outputs  occur  in  two  forms:  (i)  printed  out¬ 
put  via  subroutine  PRINTS,  and  (ii)  output  for  plotting 
purposes  which  is  transferred  to  a  plot  file  via 
subroutine  PLDATA .  The  true  reference  trajectory  data 
which  drives  the  INS  error  model  is  precomputed  by  a 
separate  program  PROFGENL 12  ].  Besides  driving  the  error 
model,  the  true  reference  trajectory  data  is  also  used 
to  construct  simulated  true  pseudo-range  and  delta  pseudo- 
range  measurements. 


5 .  ■'  Strandown  Inertial  Navigation  System  Performance 

The  results  of  Intermetric's  simulations  of  integrated 
GPS/strapdown  inertial  system  performance  have  been  published 
in  a  separate  document,  "Some  Efforts  of  High  Dynamic  Traject¬ 
ories  on  Strapdown  Inertial  Navigation  System  Performance",  by 
Prasun  K.  Sinha  and  William  S.  Widnall,  dated  6  January  1978  [15]. 
This  document  presents  the  results  obtained  from  simulation  of 
a  typical  strapdown  inertial  navigator  mounted  in  an  aircraft 
such  as  «n  F-4  which  flies  a  trajectory  representative  of  a 
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tactical  mission  profile.  The  error  model  for  the  strapdown 
baro-inertial  naviqator  and  the  flight  trajectory  which  drives 
the  error  model  are  presented  in  Section  II.  The  results  of  the 
simulation  are  presented  and  discussed  in  Section  III.  Conclu¬ 
sions  are  presented  in  Section  IV.  The  conclusions  are  repeated 
here  as  the  remainder  of  this  section. 

The  performance  of  a  typical  strapdown  inertial 
navigation  system  in  a  high  dynamic  aircraft  flight 
environment  has  been  simulated.  The  results  demonstrate 
significant  degradations  in  the  three  components  of  INS 
attitude  error  as  a  result  of  the  sustained  maneuvering, 
fhe  large  horizontal  attitude  errors  then  propagate  into 
large  horizontal  velocity  errors. 

The  aircraft  trajectory  included  two  360°  circles,  one 
turning  to  the  right  followed  by  one  turning  to  the  left. 

Because  angular  velocity  error  in  a  steady  turn  describes 
a  coning  motion  in  east-north-up  coordinates  with  the  axis 
of  symmetry  vertical,  the  resulting  sinusoidal  east 
and  north  components  of  angular  velocity  error  have  no  net 
integral  at  the  end  of  each  complete  circle.  Hence  the 
horizontal  components  of  attitude  error  are  not  significantly 
changed  by  a  circle. 

The  azimuth  error  in  circling  flight  is  changed. 

The  sources  of  error  that  gave  the  largest  contribution  to 
azimuth  error  in  each  circle,  for  the  steeply  banked  turns 
simulated,  were: 

1)  the  torquer  scale  factor  error  of  the  right-wing 
axis  gyro 

2)  the  misalignments  of  the  belly-axis  and  right-wing 
axis  gyros  about  the  forward  axis 

3)  the  g-sensitivity  of  the  belly-axis  gyro  to  specific 
force  along  that  axis.  The  change  in  azimuth  due  to  the  first 
effect  has  a  sign  which  depends  on  whether  the  aircraft  is 
turning  left  or  right,  so  its  net  effect  may  be  small  if  an 
aircraft  trajectory  circles  both  ways  a  comparable  amount.  The 
second  and  third  effects  contribute  azimuth  error  rates  whose 
signs  do  not  depend  on  whether  the  aircraft  is  turning  left 

or  right,  so  their  effects  rectify.  If  the  circling  turns  were 

nc  .  steeply  banked  turns,  then  one  would  expect  the  torquer 
scale  factor  error  of  the  belly-axis  gyro  to  also  be  a 
significant  source  of  error.  And  if  there  is  no  torquer 
scale  factor  asymmetry,  this  effect  will  rectify. 


5-4 


The  aircraft  trajectory  also  included  several  segments 
of  coordinated  zig-zag  maneuvering.  Very  large  attitude  error 
about  the  forward  axis  developed  during  this  maneuvering.  The 
sources  of  error  making  the  largest  contribution  to  forward 
attitude  error  were:  1)  the  assumed  gyro  torquer  scale  factor 
asymmetry  of  the  forward-axis  gyro,  and  2)  the  misalignment 
of  the  forward-axis  gyro  about  the  belly  axis. 

The  first  source  of  error  has  a  large  effect  because  the 
assumed  zig-zag  maneuvering  involves  repeated  left  and  right 
roll  rates  along  a  roughly  constant  heading.  The  amplitude 
of  these  roll  angle  changes  times  the  difference  between  the 
torquer  scale  factor  error  for  positive  and  negative  torquing 
is  the  net  attitude  error  in  the  forward  direction  introduced 
by  each  rol 1 -lef t--rol 1-r ight  cycle. 


The  second  source  of  error  is  signficiant  because  of  an 
interesting  property  of  coordinated  turns  in  aircraft. 

Regardless  of  whether  the  aircraft  is  turning  to  the  left  or 
turning  to  the  right,  the  angular  velocity  component  along  the 
right-wing  is  positive.  Hence  the  forward-axis  gyro,  if  mis¬ 
aligned  about  the  belly-axis,  always  contributes  a  forward- 
axis  angular  velocity  error  in  a  turn  whose  sign  is  independent 
of  the  turn  direction. 

The  sources  of  error  that  gave  the  largest  contribution 
to  up  (or  azimuth)  attitude  error,  for  zig-zag  portions  of 
the  trajectory,  were  1)  the  misalignment  of  the  belly-axis 
and  right  wing  axis  gyros  about  the  forward  axis,  2)  the 
g-sensitivity  of  the  belly-axis  gyro  to  specific  force  along 
that  axis,  and  3)  the  belly-axis  gyro  torquer  scale  factor 
asymmetry.  The  torquer  scale  factor  error  of  the  right-wing 
axis  gyro  was  not  one  of  the  largest  contributors  to 
azimuth  error  in  the  zig-zag  maneuvering  because  its  contribution 
in  a  right  turn  is  the  negative  of  its  contribution  in  a  left 
turn  (equal  bank  angles  assumed.) 


The  attitude  errors  of  this  strapdown  system  in  this 
highly  maneuvering  environment  are  large  compared  with  the 
attitude  errors  of  a  typical  local  level  inertial  system 
subjected  to  the  same  environment.  The  resulting  horizontal 
velocity  and  position  errors  are  large  compared  with  the 
errors  of  a  local  level  system  in  the  same  environment.  The 
reader  who  wishes  to  make  such  a  comparison  may  refer  to 
Referencc[ 13 ] ,  in  which  the  error  model  of  a  local  level 
LN-15  is  exercised  using  the  same  high-dynamic  aircraft 
trajectory. 
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SECTION  VI 

EAR/GEANS  ERROR  ISOLATION  FILTER  SUPPORT 


6 . 1  Chapter  Summary 

The  Air  Force  Avionics  Laboratory  (AFAL)  is  sponsoring  the 
integration  of  the  Westinghouse-developed  Electronically  Agile 
Radar  (EAR)  with  the  Honeywell  Gimballed  Electrostatic  Gyro 
Aircraft  Navigation  System  (GEANS)  to  provide  accurate  inflight 
estimates  of  position  and  velocity  as  a  function  of  time.  In 
addition,  AFAL  is  supporting  the  EAR/GEANS  program  by  develop¬ 
ing  flight  data  analysis  software  to  obtain  a  performance  as¬ 
sessment  after  each  flight. 

The  flight  data  analysis  software  is  to  take  the  form  of 
an  Error  Isolation  Filter  (EIF)  computer  program.  The  EIF  is  a 
high-order  Kalman  filter/smoother  designed  to  yield  refined 
trajectory  estimates  and  to  detect  off-nominal  performance  in 
various  subsystems  (EAR  radar,  INS,  altimeter,  etc.). 

Intermetrics  has  provided  analytic  support  to  AFAL  in 
several  areas  related  to  the  EAR/GEANS  EIF  development.  Speci¬ 
fic  issues  that  have  been  analyzed  in  depth  are  the  following: 

i)  EAR/GEANS  EIF  development  plan; 

ii)  Vertical  channel  error  model  for  the  EAR/GEANS; 

iii)  Fundamental  error  dynamics  for  a  space  stable  navi¬ 
gator; 

iv)  Error  model  for  the  baro-damped  GEANS  inertial 
navigator; 

v)  Radar  measurements  and  measurement  matrices  for  EAR; 

vi)  Geodetic  error  models  for  simulating  and  estimating 
INS  error  behavior; 

vii)  EAR  flight  test  data  recording  requirements; 

viii)  Filter  synthesis  for  the  EAR/GEANS  Error  Isolation 
Filter; 
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ix)  Feedback  correction  equations  for  EAR/GEANS  EIF; 

x)  Filter/Smoother  Mechanization  Equations  for  EAR  GEANS 
EIF. 

Results  of  these  analyses  are  presented  in  Sections  6.2  to  6.11. 


6 . 2  EAR/GEANS  EIF  Development  Plan 

Results  of  Intermetrics '  effort  on  this  subtask  have  been 
published  in  a  separate  document,  "Error  Isolation  Filter  tor 
EAR/GEANS  Development  Plan,"  by  Peter  A.  Grundy,  dated  30 
September  1977  [22]. 

This  document  outlines  a  proposed  development  plan  for  the 
EIF  for  the  EAR/GEANS  system.  It  addresses  five  broad  areas 
which  constitute  the  principal  steps  in  the  computer  program 
development  and  qualification,  to  wit: 

i)  Analysis; 

ii)  Top-level  design  and  interface  definition; 

iii)  Detailed  design  and  coding; 

iv)  Testing; 

v)  Maintenance. 

In  addition,  the  report  addresses  the  interleaving  and  sequenc¬ 
ing  of  these  tasks  and  outlines  a  preliminary  schedule  and  man¬ 
loading  plan. 
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6 . 3  Vertical  Channel  Error  Model  for  EAR/GEANS 


This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#07-77,  "Review  of  AFAL  Technical  Memorandum  'A  Vertical  Channel 
Error  Model  for  EAR/GEANS’",  by  Peter  A.  Grundy,  dated  22  Sep¬ 
tember  1977  [23]  .  The  subject  AFAL  technical  memorandum  is 
Reference  [24]. 


I  have  reviewed  the  above  referenced  memo  as  requested 
in  our  EAR/GEANS  EIF  support  effort  task  statement.  The 
following  comments  seem  to  be  appropriate. 


6-3*1  Observability  in  Second-Order  Damping  Loop 

We  are  in  agreement  as  to  the  appropriate  models 
(Eqs.  (9)  and  (11)  in  the  above  memo)  for  third  and  second 
order  damping  loops.  I  would,  however,  like  to  point  out 
an  additional  characteristic  of  the  second  order  loop 
performance,  which  may  impact  the  EIF  design. 


Consider  the  four  state  model  for  the  second  order 
vertical  channel 
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The  corresponding  frequency  domain  equations  can 
derived  as 
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be  readily 


Using  the  final  value  theorem,  it  can  be  seen  that,  for  step 
inputs  of  vertical  acceleration  error  5az  and  barometric  altitude 
error  Sh^,,  the  steady-state  altitude  and  velocity  errors  are 
given  by 


where  SAZ,  6Hb  are  the  magnitudes  of  the  forcing  function  steps 
Note  that  if  the  vertical  acceleration  error  step  magnitude 
(e.g.,  vertical  accelerometer  bias)  and  the  barometric  altitude 
error  satisfy  the  relation 


the  steady  state  altitude  error  is  zero  but  a  vertical 
bias  of 


persists.  Measurements  of  aircraft  altitude  alone  do  not 
provide  observation  of  the  vertical  velocit 


error  or  separa 


tion  of  vertical  acceleration  and  barometric  altitude  error 


Stated  in  another  fashion,  substitution  of  the  state 


into  Equation  (1)  yield  a  zero  state  time-derivative  vector. 
This  state  therefore  represents  a  possible  constant  system 
mode  with  zero  altitude  error.  Note  that  a  100  ug  vertical 
acceleration  error  results  in  a  substantial  .36  m/sec  vertical 
velocity  error  bias. 

Recurr  now  to  the  standard  definition  of  observability. 

For  an  n-dimensional  state  vector  x,  we  observe  the  rank  of 
the  observability  matrix 


H 

H  F 


where  H  is  the  measurement  gradient  matrix.  For  the  error 
state  considered,  H,  for  an  altitude  measurement,  is  given  by 

H  =  [1000]  (6.3-8) 

The  observability  matrix  is,  therefore 
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row  =  d  row,  -  a  row, 

4  2  3  (6.3-10) 

The  rank  of  Z  is  then  three  and  the  system  has  one 
unobservable  mode. 

Error  state  observability  can  be  obtained  through  additional 
measurements : 


i)  inertial  altitude  difference  measurement  -  i.e., 
the  difference  between  INS  and  barometric  indi¬ 
cated  altitude.  For  this  measurement,  the 
gradient  matrix  is 


H  -  H  0  0  -1]  (6.3-1]) 

The  observability  matrix  for  three  altitude 
measurements  plus  one  altitude-difference  measure¬ 
ment  can  be  shown  to  be  of  the  full  rank. 
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Practical  observability  with  this  measurement, 
however,  is  another  matter.  For  the  gains  given 
in  the  memo 


c^  =  .01  sec 

c^  =  2.81  x  10  ^  sec 

c.  =  1  sec 
4 


for  each  10  meters  of  short-correlation  baro- 
altitude  error,  a  corresponding  vertical  accelera¬ 
tion  estimation  uncertainty  of 


0($a  =  28  yg's  (6.3-13) 

z 

will  result.  Furthermore,  the  filter  designer 
must  also  consider  that  the  noise  in  the  altitude 
difference  measurement  is  correlated  with  the 
error  state  driving  noise,  so  further  deweighting 
of  the  altitude  difference  measurement  would  result. 


ii)  Direct  velocity  measurement  -  i.e.,  the  difference 
between  the  INS  indicated  and  an  external  measure 
of  vertical  velocity.  For  this  measurement,  the 
gradient  matrix  is 


H  =  [0100]  (6.3-14) 


and  the  observability  matrix  resulting  from  a  combi¬ 
nation  of  altitude  and  vertical  velocity  measure¬ 
ments  can  be  shown  to  be  of  full  rank.  I  understand 
this  to  be  the  main  operating  mode  of  the  system, 
where  the  EAR  radar  is  obtaining  both  position  and 
velocity  measurements,  so  the  above  comments  are  not 
directly  relevant.  However,  should  the  radar  fail 
in  flight,  and  the  analyst  desire  to  evaluate  GEANS 
by  comparison  to  CIRIS  data,  the  above  observations 
become  directly  relevant. 


ii .  4  Fundamental  Error  Dynamics  for  a  Space  Stable  Navigator 


This  section  comprises  Intermotrics  AFAL/Grs  Analysis  Memo 
#08-77,  "Review  of  ARAL  Technical  Memorandum  'Fundamental  Error 
Dynamics  for  a  Space  Stable  Navigator ' , "  by  Deter  A.  Grundy, 
dated  22  September  1977  [25].  The  subject  AFA1,  Technical  Memo¬ 
randum  is  Ref.  [26]. 

We  are  in  agreement  as  to  the  developed  fundamental  error 
model.  We  suggest,  however,  the  slightly  different  and 
simpler  derivation  of  the  platform  attitude  error  expressions. 

The  inertial  system  misalignment  or  attitude  error  is 
contained  in  the  error  in  the  coordinate  transformation 
matrix  C*.  For  small  angles,  we  can  define  this  error  to  be 
a  vector  8. 

The  computed  ti  .instoi  mation  matrix  is  related  to  the  true 
by  the  expression  (Ref. [27]  ,  pp.  21-22,  25) 


C1  -  (1  -  uMc1 
P  P 


(6.4-1) 


where  D  is  the  skew-symmet r ic-matr i x  form  ot  the  vector  6. 
Taking  the  time  derivat ive  ot  the  above  oquat ion 


Cl  »  -bV  Cl  +  (l  -  D1)C1 
p  p  P 


( 0  .  4  -  2 ) 


The  time  derivative  of  the  direction  cosine  matrices  is 
given  by  (Ref.  [  27 1  pp.  10-17) 


,t  .t  ,P 

1  -  <2  IP. 

P  P  IP 


,  t  >>  ,P 

C  ■  C  Q; 

p  p  1  p 


( o .  4  -  n 


!>  p 

where  are  the  skew-symmet  t*  u:-nu(  r  i  x  term  ot  the 

ip  ip 


,  p  p 

angular  velocity  vectors  ,  w\  , 


Hence,  we  obtain 


A  •  /A 


C1  0?  -  -B1  C1  +  (I  -  B1)C1 

p  ip  p  p  IP 


o(6. 4-4) 


We  define  the  angular  velocity  error  of  the  platform  with 
respect  to  inertial  space  as 


6wP  =  wP 


-  wP 
ip  -IP  -ip 


(6.4-5) 


Substituting  Equations  (1)  and  (5)  (in  skew-symmetric- 
matrix  form)  into  Equation  (4),  and  neglecting  second  order 
terms,  yields 


B1  =  -C1  5UP  CP 
p  ip  l 


i  6 . 4-6 ) 


which  in  column  vector  form,  is  written  as 


6-  =  -CX  6wP 

-l  p  -ip 


(6.4-7) 


6.5  Error  Model  for  the  Baro-Damped  GEANS  Inertial  Navigator 

This  section  comprises  Interme tr ics '  AFAL/GPS  Analysis 
Memo  #09-77,  "Review  of  AFAL  Technical  Memorandum  'An  Error  Model 
for  the  Baro-Damped  GEANS  Inertial  Navigator',"  by  Peter  A.  Grundy, 
dated  18  October  1977(28]  .  The  subject  AFAL  Technical  Memorandum 
is  Ref .  ( 29 ] . 

Comments  on  the  above  memo  contents  are  directs  to  three 
general  areas. 
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6.5.1 


Formulation  of  Vertical  Channel  Aiding  Error  Model 


This  area  exhibits  the  normal  awkwardness  associated 
with  describing  effects  associated  with  the  geographic  frame 
in  another  coordinate  system.  While  the  formulation  hangs 
together,  numerous  approximations  are  required  to  obtain  a 
reasonably  simple  set  of  error  differential  equations. 

Error  differential  equations  for  terrestrial  navigators 
are  more  naturally  expressed  in  the  frame  they  are  attempting 
to  navigate,  i.e.,  that  defined  by  geographic  longitude, 
latitude  and  altitude. 

A  couple  of  particular  observations  in  relation  to  the 
analytical  development  in  this  area  are  submitted  for  your 
consideration .  In  relation  to  equation  (3-9)  in  the  memo, 
the  approximation 


r  cos  D  »  r 
o  o  o 


(6.5-1) 


is  not  by  itself  a  good  approximation.  The  deviation  of  the 
vertical  D0 ,  at  Dayton  latitudes,  approaches  its  maximum 
value  of  ~3  mrads.  The  error  in  the  approximation  of 
equation  (1)  is  therefore 


1 

2 


90  ft 


( 3. 5-2) 


If  this  approximation  error  persisted  through  the  formula¬ 
tion,  it  would  be  interpreted  by  the  estimator  as  a  reference 
fbaro)  altitude  error.  Note,  furthermore,  that  the  error 

magnitude  is  comparable  to  the  assumed  steady-state  standard 
deviation  for  the  "error  in  Blanchard-computed  altitude" 
state  eBA  and  hence  is  not  readily  negligible. 


The  above  approxima tion  is  partially  compensated,  however, 
by  the  additional  approximation 


,„i  n.  l 

Cn  V  I 


(6.5-3) 
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so  that  the  total  computation  error  for  Ah  is  less  than  1 
and  clearly  negligible. 

The  above  considerations  are  brought  up  because  it  is  not 
explicitly  stated  in  the  memo  what  the  GEANS  algorithms  for 
computation  of  the  aiding  variable  Ah  is.  The  onboard  scheme 
should  be  carefully  analyzed  to  ascertain  the  absence  of 
deterministic  error  forcing  functions  such  as  that  described 

by  equation  (6. 5r] ). 


6.5.2  Computation  of  Geographic  Coordinates 

It  is  not  clear  to  this  reader  what  the  intended  use 
of  the  formulas  presented  in  Sections  3.4  and  4.7  for  computa¬ 
tion  of  geographic  coordinates  are.  It  should,  however,  be 
pointed  out  that  the  stated  expressions  contain  significant 
errors . 

Consider,  in  particular,  the  expression  for  computation 
of  geographic  latitude  L  (equation.  (3-19)  in  the  memo). 
Referring  to  the  elliptical  cross-section  depicted  in  Fig.  12 
it  can  be  shown  that  the  geographic  latitude  L  is  related  tc 
the  geocentric  latitude  Leo  of  a  point  on  the  surface  of 
the  ellipsoid  by  the  expression 


tan  L 


CO 


( l-e‘ 


)  tan  L 


(6.5-4) 


where  e  is  the  eccentricity  of  the  reference  ellipsoid.  For 
the  WGS-72  earth  model,  e  =  .08181881066;  hence 


L  =  arctan ( 1 . 00673966  tan  LCQ)  (6.5-5) 
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Figure  12:  Elliptical  Cross-Section 


Note,  however,  that  the  aircraft  at  altitude  h,  has  not 
changed  geographic  latitude.  The  geocentric  latitude,  as 
determined  from 


L 


c 


r 

arctan  — - 
rH 


(6.5-6) 


has  certainly  changed  from  its  surface  value  of  L(jq. 
Alternatively,  aircraft  motion  along  the  geocentric  radius 
p  causes  geographic  latitude  to  change  while  geocentric 
latitude  remains  constant.  Equation(-5)  (or  equation  (3-19) 
in  the  memo)  do  not  reflect  this  effect. 

An  alternative  algorithm  obtains  as  in  equation(-6) . 
The  geographic  latitude  differs  from  this  value  by  the  devia¬ 
tion  of  the  vertical  D 


L  =  Lc  +  D 


(6.5-7) 
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The  deviation  of  the  vertical  is  given  by 


D  =  f  sin  2Lc(l-h/a)  +  |  f2  sin  2LC  (2  cos  2Lc  +  1) 
+  0(f3) 


(6.5-8) 


to  an  accuracy  of  .5  ft,  where  f  is  the  earth's  flattening 

( 1-f ) 2  *  1-e2  (6.5-9) 


and  a  is  the  earth's  equatorial  radius. 

Note  that,  at  45°  latitude,  neglecting  the  altitude  effect, 
causes  a  geographic  north  position  error  of  ~3  ft  per  1000  ft 
of  aircraft  altitude.  This  computation  error  is  clearly 
unacceptable  for  such  purposes  as  comparison  of  GEANS  solution 
to  CIRIS  solution. 

From  similar  considerations  as  above,  computation  of 
latitude  and  longitude  errors  from  north  and  east  position 
errors  should  rely  on  the  north  and  east  radii  of  curvature 


pM  =  a  ( 1-e*")  /  ( l-e“  sin"  L) 
N 

2  2 

p_  =  acos  L/ll-e  sin  L) 

£ 


(6.5-10) 


rather  than  the  equatorial  radius  as  in  equations  (4-17)  and 
(4-18).  The  involved  errors  are  of  the  order  of  3  ft  per 
1000  ft  of  position  error  at  45°  latitude. 


6.5.3  Gyro  Error  Model 

As  formulated  in  the  model,  the  RATS  drift  error  is 
inseparable  from  the  Z  gyro  g-insensi tive  drift  state.  This 
fact  is  apparent  from  the  following  two  considerations : 


i)  Both  states  are  modeled  as  random  constants 


ii)  Both  states  contribute  identically  to  the 
observables.  That  is,  both  states  directly 
drive  the  platform  attitude  errors  through  the 
coefficient  vector 
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6.6  Radar  Measurements  and  Measurement  Matrices  for  EAR 


This  section  comprises  Intermetrics  AFAL/6PS  Analysis  Memo 
#10-77,  "Review  of  AFAL  Technical  Memorandum  'Radar  Measurements 
and  Measurement  Matrices  for  EAR',"  by  Peter  A.  Grundy,  dated 
18  October  1977  [30].  The  subject  AFAL  Technical  Memorandum  is 
Ref.  [31]. 


The  developed  measurement  sensitivity  matrices  properly 
represent  the  geometrical  relation  between  measurement 
residuals  and  system  errors.  However,  I  do  not  understand 
the  EAR  measurement  process  sufficiently  well  to  comment  on 
the  measurement  error  model  itself. 

In  particular,  items  of  concern  include 


.  The  model  assumes  the  sensor  measurement  error 
to  be  purely  random.  Is  this  an  adequate 
representation? 

.  Is  there  significant  cross-coupling  between  the 
various  EAR  measurements?  For  example,  is  the 
checkpoint  position  error  significant  relative 
to  the  truly  random  measurement  noise  so  that 
the  additive  errors  in  the  position  measurement 
quadruple  should  be  considered  highly  correlated? 

.  How  is  the  position  ambiguity  resulting  from  the 
range/range-rate  fix  resolved?  Does  this  resolu¬ 
tion  affect  azimuth/elevation  measurement  errors 
in  poorly  conditioned  geometries? 


The  above  issues,  if  relevant,  may  affect  the  EIF  filter 
synthesis  process. 
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This  section  comprises  Intermetrics'  AFAL/GPS  Analysis  Memo 
#78-01,  "Review  of  AFAL  Technical  Memorandum  'EAR  Flight  Test 
Data  to  be  Recorded  on  the  CIRIS  Recorder  for  Error  Isolation 
Filter  PostDrocessina '  ,  '*  bv  Lawrence  F.  Wiederholt,  dated  26 
January  1978  T32l.  The  subject  AFAL  Technical  Memorandum  is 
Ref.  [ 33 1 . 

In  general,  the  data  recording  requirements  are  sufficient  to 
operate  the  EIF.  Two  areas  commented  on  here  are  the  specific 
force  determination  and  the  unit  vectors  associated  with  the 
measurements . 

No  accelerometer  data  is  directly  recorded  because  of  the 
high  data  rates  involved.  Instead,  specific  forces  will  be 
computed  by  back-dif ferencing  r  and  solving  Eq .  (3-12b)  of 

Ref.[29']for  fp.  This  method  of  determining  specific  forces  is 
accept  ble  because  a  high  accuracy  is  not  required  for  the 
transition  matrix  which  is  the  only  use  made  of  specific  force. 
This  approach  was  used  on  the  CIRIS  program. 

Unit  vectors  associated  with  the  velocity  and  position 
measurements  (Block  2  and  3)  are  recorded.  These  unit  vectors 
are  required  for  the  H  matrix  evaluation  and  probably  for  the 
EIF  residual  computation  also.  This  depends  on  the  exact  form 
used  to  compute  the  EIF  residuals  which  has  not  been  completely 
defineu  yet.  The  concern  is  whether  flight  recorded  values  from 
the  onboard  system  or  computed  values  from  the  EIF  computation 
should  be  used.  In  forming  the  residuals  EIF  computed  values 
should  be  used  because  they  are  more  accurate  than  the  fliqht 
recorded  values.  Because  of  the  sensitivity  of  the  state  vector 
update  to  errors  in  the  residual,  the  most  accurate  values 
available  should  be  used. 

The  state  vector  update  is  less  sensitive  to  the  H  matrix 
evaulation,  so  use  of  flight  recorded  values  here  may  be 
acceptable  although  an  analysis  should  be  performed  to  justify 
this  usage.  Using  flight  recorded  values  eliminates  the  need 
to  compute  the  unit  vectors  in  the  EIF,  yet  if  they  are  computed 
for  the  residual  they  should  be  used  for  the  I!  matrix  also.  One 
may  still  want  to  record  the  unit  vectors  to  provide  measurement 
direction  information  useful  to  the  analyst.  Also  the  computa¬ 
tions  required  to  define  the  unit  vectors  in  the  EIF  should  be 
examined  to  insure  having  all  the  required  data. 


6 . 8  Geodetic  Error  Models  for  Simulating  and  Estimating  INS 
Error  Behavior 


This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#78-02,  "Review  of  AFAL  Memorandum  '  Geodetic  Error  Models  for 
Simulating  and  Estimating  INS  Error  Behavior',  AFAL-TM-77-44 , " 
by  Peter  A.  Grundy,  dated  6  March  1978  [34].  The  subject  AFAL 
technical  memorandum  is  Ref.  [35]. 


6.8.1  Introduction 


This  memo  contains  comments  and  recommendations  resulting  from  a  review 
of  the  above  referenced  document.  Section-2  of  this  memo  defines  the 
geodetic  error  quantities  and  discusses  their  significance  for  the  EAR/GEANS 
error  source  recovery  problem.  Section -3reviews  relevant  papers  quoted  in 
your  memorandum  in  terms  of  their  implications  for  this  process,  and 
Section-4  summari zes  conclusions  and  suggestions  reached  in  this  analysis. 


6.8.2  Basic  Concepts 

Geodetic  errors  represent  a  source  of  acceleration  disturbance  for  an 
inertial  navigator  attempting  to  track  a  vehicle's  position  relative  to 
the  reference  ellipsoid.  In  particular,  for  a  high  accuracy  system  such  as 
GEANS,  they  represent  one  of  the  limiting  effects  on  navigation  performance. 

The  gravity  disturbance  vector  6a  is  defined  as  the  difference  between 
the  actual  and  modeled  gravity  vectors  when  evaluated  at  the  same  point 


^  ^actual  p  ’  ^fliodel  ^ 


(6.3-1) 


The  gravity  disturbance  vector  6a  is  expressed  in  geodetic  coordinates 
(north-east-down)  as 


r  n 

« 


go  5 
-g0  n 

Ag 


where 

C 

n 


=  gravity  deflection  about  east 
=  gravity  deflection  about  north 
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***** 


Ag  =  gravity  anomaly 
gQ  =  gravity  magnitude 

In  addition,  the  undulation  N  is  defined  as  the  altitude  difference  between 
the  actual  surface  of  constant  gravity  potential  (the  "geoid")  and  the  modeled 
surface  (the  "reference  ellipsoid"). 

Gravity  disturbances  enter  the  inertial  solution  because  accelerometers 
measure  specific  force  fjn.  In  order  to  generate  acceleration  for  integration 
of  the  inertial  navigation  equations,  a  modeled  value  of  gravity  must  be 
added  to  i t 


a=f+g.,  (6.8-3) 

—  -in  ^roodel 

An  inertial  navigator's  vertical  channel  is  inherently  unstable,  and  must 
be  stabilized  through  some  external  altitude  reference.  Such  external 
references  (e.g.,  baro-al timeter)  provide  altitude  with  respect  to  the  geoid, 
and  hence,  cause  an  error  in  the  INS  indication  of  altitude  over  the  reference 
ell ipsoid. 

In  general,  geodetic  errors  are  partitioned  into  global  and  local  compo¬ 
nents,  depending  on  the  area  of  interest.  Global  errors,  for  the  restricted 
area  flights  envisioned  for  EAR/GEANS,  appear  as  acceleration  error  biases  to 
the  INS.  For  local-level  navigators,  such  global  errors  are  indistinguishable 
from  accelerometer  biases  due  to  the  quasi-constant  orientation  of  the  instru¬ 
ments  to  the  gravity  error  components.  In  strapdown  systems,  such  correlation 
does  not  develop,  because  the  instruments  can  be  rapidly  rotated.  Space- 
stable  systems  represent  an  in-between  case,  where  the  separability  depends 
on  the  level  of  stability  that  can  be  assumed  for  the  instrument  error  sources. 

To  illustrate,  for  an  at-rest  system,  the  platform  rotates,  with  respect 
to  local  geodetic  axes,  at  earth  rate  (15°/hr).  Assuming  that  the  instruments 
are  initially  aligned  with  these  axes,  after  three  hours  they  have  rotated  45° 
relative  fo  the  gravity  disturbance  components.  If  the  instrument  errors  are 
sufficiently  stable,  some  of  the  error  sources  are  clearly  separable. 

Although  local  gravity  disturbances  are  actually  deterministic,  they  are 
usually  treated  at  zero-mean,  two-dimensional  spatial  random  processes  because 
of  their  wide  frequency  spectrums.  This  type  of  modeling  is  specially  suited 
to  optimal  (Kalman)  estimation  applications.  This  is  the  case  for  the  EAR/ 
GEANS  problem,  where  it  is  proposed  to  apply  a  Kalman  estimator  to  recover 
the  system  sources  of  error  in  the  presence  of  external  disturbances,  of  which 
gravity  errors  are  a  prime  example. 

Two  properties  usually  associated  with  local  gravity  error  models  are 
that  1)  they  are  homogeneous ;  that  is,  the  spatial  autocorrelation  (acf) 
function  at  any  point  is  orfl y  a  function  of  the  distance  shifts 


'p(x,  y,  x+Ax,  y+Ay)  =  $(Ax,  Ay) 


(6.8-4) 


and  2)  they  are  isotropic: 
shift 


that  is,  that  acfs  are  independent  of  direction  of 
♦  (Ax,  Ay)  =  <f>(r) 

- -  (6.8-S) 

r  =  Vax2  +  Ay2 


6.8.3  Literature  Review 

ssii?*  n  *iv}$ 

anc^Na  sbf 421  He,s[U*  *>  «ti«.atiop,  copta.Jg  t^Ro^01’  ^ 

SSJiSSVt^iiS  "U''  C0"si<,era"°"  °f  <**«•«,  by 

6>8*3.1  Quality  Error  Modeling 

6. 8. 3. 1.1  Space-Domain  Models 

..  standard  papers  (Shaw,  Paul  and  Henri kson[36 1  and  Jordarf  isD 
estabiish  the  theoretical  basis  for  gravity  error  moael  development  Shaw 

the  outoIItsSofaa  iSm  1°cal  ,vertical  Reflection  components  caS  be  treated  as 
the  outputs  of  a  1  near  two-dimensional  system  driven  by  a  random  input 

dPri!cHyfan°mt!1e^ ’  W1th  the  frePuency  response  function  of  the  linear  system 

Thev  sholT Jhf  f  3t  Tth  aPProx1mation  the  Vening  Meinesz  formulas  [46] 

They  show  that  for  any  homogeneous,  isotropic  model  for  the  gravity  anomaly  J 
the  correlation  functions  for  the  vertical  deflection  components  are  gWenby 


<|,«(prp2)  =  °6  ^gg(r)/°g2  -  f(r)cos20] 


0nn^pl’p2^  =  °6  ^gg(r)/og  +  f(r)cos20] 


(6.8-6) 


WP1,P2^  = 


V(prp2}  = 


-o^2  f(r)sin20 
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where 


=  deflection  variance 
=  anomaly  autocorrelation  function 

=  anomaly  variance 


V2  2 

P1  +  p2 

=  shift  angle  from  north  =  tan*l(p^/p 


anomaly  model  dependent  function 


Shaw  et  al  point  out  that  the  deflection  variance  a,  independently  of  the 
selected  anomaly  model,  is  given  by 


2  2  2 

°6  =  °g  /2go  (6.8-7) 

as  long  as  the  anomaly  is  isotropic  and  homogeneous;  and  that,  even  though  the 
anomaly  process  is  isotropic,  the  deflection  statistics  are  direction  dependent. 
The  deflections  can  only  be  considered  isotropic  in  an  ensemble  sense,  i.e., 
when  averaged  over  a  uniformly  distributed  shift  angle  0. 

In  addition,  Jordan[38] derives  theoretical  constraints  between  deflections 
and  anomaly  and  the  undulation  of  the  geoid,  thus  allowing  formulation  of 
consistent  statistics  for  all  four  geodetic  quantities.  The  undulation  and 
anomaly  autocorrelation  functions  are  related  through  the  two-dimensional 
Poisson  equation 


2  2  \ 

~1  +  ~2Pnn(pi*p2)  =  '  “1  'i>gg(prp2) 
(3pl  3P2/  5o 


(6.8-8) 


while  the  deflections  satisfy 


‘Wprp2)  = 


9  ^NN  ^P1 ,p2^ 


(6. S-9) 


4'nn(PrP2) 


9  (’NN  ^P1  ,p2^ 

3o-t  ^ 
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where  $NN  is  the  undulation  autocorrelation  function. 

A  variety  of  gravity  error  models  have  been  suggested  which  satisfy  all 
or  some  of  the  above  constraints.  Jordan[39  ] provides  a  comparative  evalua 
tion  of  a  representati ve  set  of  four  of  these  models. 


•  a  model  proposed  by  Shaw  et  al ,  where  the  anomaly  autocorrelation 
function  is  assumed  to  be  exponential,  and  vertical  deflection 
statistics  are  obtained  through  the  Vening  Meinesz  formulas  - 

E  model 

•  a  model  proposed  by  Kasper  [37],  where  the  anomaly  is  assumed  to 
be  a  second-order  Markov  process,  and  the  vertical  deflection 
statistics  are  obtained  through  the  Vening  Meinesz  formulas  - 
K-2  model 

•  two  models  proposed  by  Jordan,  where  the  undulation  is  assumed  to 
be  a  second-order  and  a  third-order  Markov  process,  and  the 
anomaly  and  deflection  statistics  are  derived  through  equations 
(6.8-8  and  9)  -  J-2,  J-3  models. 


E-Mode  I 


(r) 


K-2  Model 


J-2  Model 


J-3  Model 


4>gg(r)  =  og2[l  +  (r/d)]e‘r/d  (6.8-10) 

4>NN(r)  =  °n2[1  +  (r/d)]e'r/d 
4>gg(r)  =  ag2[l  -  (r/2d)]e'r/^d 

$NN(r)  =  aN2[l  +  (r/d)  +  (r2/3d2)]e’r/d 

4>gg(r)  =  crg2[l  +  (r/d)  -  (r2/2d2)]e'r/,d 
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The  characteristic  distances  of  the  various  models  are  related  to  the 
convenient  and  measurable  anomaly  correlation  distance  c^  according  to 


c 

c 

c 

c 


g 

g 

g 

9 


=  d 

E -model 

=  2.1 46d 

K-2  model 

=  0.6252d 

J-2  model 

=  1 . 36 1  d 

J-3  model 

(5.8-11) 


The  vertical  deflection  correlation  functions  which  result  from  applica¬ 
tion  of  the  Veiling  Meinesz  formulas  to  these  generating  functions  are  given 
Table  I. 


The  statistics  derived  above  are  valid  at  a  constant  geodetic  altitude 
(usually  the  surface  of  the  earth).  Bernstein  and  Hess  [6]  have  investigated 
the  gravity  error  sensitivity  to  altitude,  and  report  changes  of  the  order 
of  25"  at  20,000  ft  and  50'".  at  40,000  ft  for  the  anomaly  variance  for  some 
simple  models  (E  and  K-2  above).  However,  they  also  report  that,  at  larger 
shifts  from  the  origin,  the  acf  is  basically  unchanged.  Thus,  the  effect  of 
increasing  altitude  is  to  suppress  high  frequency  (short  wavelength)  components. 
This  conclusion  is  supported  by  gravity  field  spherical  harmonic  analysis, 
where  the  magnitude  of  the  nth  degree  harmonic  component  is  found  to  he 
proportional  to  (rL>/r)‘n,  with  r  -  re  +  h.  Hence,  with  increasing  altitude, 
the  higher  degree  (higher  frequency)  harmonics  experience  larger  suppression. 


(•8.3,1>2  Trans  lotion  to  Time-  Domain 

The  previous  section  presented  space -.domain.  st,\tistjcs  fqr  various,  random 
gravity  error  models.  However,  for  INS  linear  error  analysis  or  for  Kalman 
estimation,  the  time-doma in  ctatistics  are  the  desired  parameters. 

Space  and  time  domains  are  related  by  the  vehicle  motion 

/*t  2 

r(t,,t  „)■/  v  ( t )  d  t 

r  =  | r  |  (6.8-12) 

O  =  tan_1(rx/ry) 


• vehicle  velocity  vector. 


f( r )cos2 


For  the  vertical  deflections  to  constitute  stationary  random  processes, 
requires  that  r  and  G  be  functions  only  of  the  time  step  At  =  t2-t] .  This 
situation  only  prevails  if  1)  the  velocity  vector  is  constant,  or  2)  the 
deflections  are  considered  in  an  ensemble  sense  and  the  velocity  is  a  stationary 
random  process. 

For  the  EAR/GEANS  modeling/estimation  problem,  however,  we  are  concerned 
with  single-case,  maneuvering  flight  performance.  Therefore,  in  principle, 
any  selected  gravity  error  model  should  exhibit  non-stationary  statistics. 

This  model  characteristic  is  consistent  with  the  Kalman  estimation  structure. 

Unfortunately,  for  any  but  the  simplest  maneuver  models,  the  mathematics 
of  the  problem  become  intractable,  and  simplifications,  usually  in  the  form 
of  taking  ensemble  averages,  must  be  enforced  to  obtain  analytical,  closed- 
form  expressions  which  will  provide  insight  into  the  nature  of  the  process 
statistics. 

A  particularly  simple  maneuver  to  analyze  is  the  so-called  random  heading 
maneuver,  where  the  vehicle  is  assumed  to  move  at  constant  speed  on  a  constant, 
random  heading  which  is  uniformly  distributed  over  360°.  Taking  ensemble 
averages  over  the  distributed  heading  (thereby  eliminating  the  non-isotropic 
character  of  deflection  processes),  and  substituting  r  =  v|t|,  where  v  is  the 
aircraft  speed,  yields  the  gravity  error  time-domain  acfs  of  Table  2  for  the 
four  models  whose  space  domain  acfs  where  given  in  Table  I. 

It  can  be  expected  that  EAR/GEANS  flight  test  trajectories  will  consist 
of  constant  speed,  constant  heading  segments  joined  by  short,  constant  bank 
angle  turns.  These  two  maneuver  models  therefore  also  merit  analysis. 

For  the  constant  heading  segments,  it  is  convenient  to  transform  east  and 
north  vertical  deflection  components  to  along-  and  cross-track  components 


X  cosG  -sinO  g 

p  sinO  cosG  n 


(6.3-13) 


Substituting  r  =  v|t|,  and  transforming  to  track  coordinates,  yields  the 
time-domain  acfs  presented  in  Table  3  for  the  four  considered  models. 

The  turn  maneuver  model  is  particularly  difficult  to  analyze  due  to  the 
non-isotropici ty  of  the  deflection  statistics  and  the  non-linear  relationship 
between  space  and  time  domains.  For  a  simplistic  evaluation,  consider  an 
isotropic  deflection  process  (or  ensemble  statistics  over  uniformly  distributed 
polar  angles,  for  a  non-isotropic  one),  for  example,  the  exponential  acf 
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Table  2 

Time-Domain  Correlation  Functions  for 
Random  Heading  Maneuvers 
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and  an  aircraft  flying  a  circle  at  constant  speed  and  constant  bank  angle 
(resulting  in  constant  radial  acceleration  a).  The  distance  shift  between 
any  two  points  on  the  circle  at  two  times  t^ ,  t^,  t2*t^  =  t,  is 

Ar  =  (2v^/a)sin(ax/2v)  =  2Rsin(Tix/T)  (6.8-15) 


where  R  is  the  circle  radius  and  T  is  the  period. 

The  corresponding  time-domain  exponential  acf  is  then 

*(t)  =  o  2  e-(2R/d)sin(T,T/T)  (6.8-1 

o 

For  small  R/d  (an  aircraft  at  300  knots  with  a  45°  bank  angle  turns  with  a 
radius  of  approximately  1.5  n.mi.,  versus  a  gravity  correlation  distance  of 
about  20  n.mi.)  we  can  rewrite  Equations  (11)  and  (9)  (transformed  using 
r  =  vt)  as 


♦k(t)  =  o/[  1  -  (2R/d)sin(TtT/T)] 

<*>^(t)  =  o62[1  -  ( 2R/d ) (ttx/T ) ]  x<T 


(6.8-17) 


The  encountered  process  statistics  will  thus  be  significantly  different 
to  the  constant  heading  equivalent  when  ttx/T  <<  1  does  not  hold.  The  above 
model  (with  x  _<  T/2)  could  be  considered  to  represent  the  ensemble  statistics 
within  the  maneuver  for  a  180°  turn  when  the  vehicle  heading  entering  the  turn 
is  viewed  as  a  uniformly  distributed  random  variable. 

The  above  simplistic  discussion  was  presented  to  illustrate  the  fact 
that  maneuvering  statistics  are  significantly  different  than  those  in  straight 
flight.  A  treatment  of  this  subject  has  not  been  found  in  the  literature,  and 
considerable  more  modeling  effort  may  be  required  in  this  area. 

Finally,  the  EAR/GEANS  flight  trajectories  may  include  repeated  tracings 
of  a  standard  ground  track,  i.e.,  a  tracking  maneuver.  In  this  case, 
gravity  errors  across  a  track  period  will  be  perfectly  correlated,  and  the 
acfs  will  be  modulated  by  the  tracking  frequency,  as  discussed  by  Nasf{40]. 

He  considers  a  vehicle  moving  back  and  forth  along  a  fixed  heading  line,  with 
period  T,  and  shows  that  the  time-domain  acf  is  given  by 
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VT 

4>(r)[(l  -  (2x/T))6(r-vx)  +  (2/vT)]dr  0  <  x  <  T/2 


-t)  all  x 


x+T)  all  x 


(6.8-18) 


6. 8. 3. 1.3  Model  Evaluation 

Four  representative  space-domain  gravity  error  models  have  been  presented, 
and  their  transfer  to  the  time-domain  under  various  vehicle  maneuvers 
discussed.  None  of  these  adequately  represents  the  underlying  processes 
during  turns,  but  the  difficulty  lies  with  the  nature  of  the  maneuver  rather 
than  distinguishing  features  between  one  model  or  another.  Similarly,  the 
effect  of  tracking  maneuvers  is  basically  independent  of  the  assumed  local 
statistics.  Any  model  comparison  must  therefore  rely  on  behavior  under  the 
other  maneuver  models  considered. 

Two  relevant  criteria  on  which  to  base  a  comparison  of  the  suggested 
models  for  EAR/GEANS  purposes,  are 

1)  Is  the  Jordan  model's  completeness  (in  terms  of  representing  the 
four  gravity  error  variables  in  a  theoretically  consistent  manner) 
material ? 

2)  Are  the  differences  in  model  frequency  content  observable  to  the 
estimation  process? 


\s. 

<T>(  t  )  =  \  <t>( 

I  4>( 


The  first  consideration  translates  into  i)  is  estimation  of  the  undulation 
of  the  geoid  of  interest?,  and  ii)  is  the  undulation  observable?  As  stated  in 
Section  6.8.2,  the  governing  assumption  is  that  gravity  errors  are  not  to  be 
estimated  per  se,  but  rather  are  of  interest  only  to  the  extent  that  they 
disturb  the  recovery  of  desired  EAR/GEANS  error  sources.  Furthermore,  the 
undulation,  which  corrupts  the  baro-al timeter  indication  of  altitude  above  the 
reference  ellipsoid,  will  not  be  separable  from  other  slowly-varying  sources 
of  baro-al ti tude  error.  Hence,  the  undulation  is  neither  of  interest  nor 
observable,  and  model  completeness  a  la  Jordan  is  immaterial  to  the  EAR/GEANS 
problem.  Had  the  undulation  been  observable  (or  of  interest),  information 
about  the  anomaly  and  deflection  processes  could  have  been  obtained  from  it 
through  the  appropriate  cross-correlation  functions  (or  vice  versa). 


The  considerations  for  the  anomaly  are  not  directly  analogous  to  those 
for  the  undulation.  The  GEANS  mechanization  incorporates  vertical  channel 
baro-stabi 1 i zation  through  a  critically-damped  second-order  loop  with 
natural  frequency  u>n  ~  -005  rad/sec [ 24 ] .  The  response  time  of  this  loop 
is  only  slightly  faster  than  the  anomaly  correlation  time  for  an  aircraft 
speed  of  300  knots  and  an  anomaly  cirrelation  distance  of  20  n.mi.,  so  that 
steady-state  analysis  is  not  directly  applicable.  However,  to  provide  some 
insight,  let  us  assume  that  the  loo.'  response  is  significantly  faster.  Then, 
the  steady-state  altitude  and  vertical  velocity  errors  are  given  by  [23]  « 
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where  k],  k2  are  the  stabilization  loop  gains,  k4  is  the  altimeter  lag  compensa¬ 
tion  coefficient,  6AZ  is  the  vertical  acceleration  error,  and  6hb  is  the  baro- 
altitude  error. 

Given  EAR-based  observations  of  altitude  and  vertical  velocity,  6AZ  can 
be  isolated  from  equations  (6.8-19) In  turn,  SAZ  is  the  linear  combination  of 
accelerometer  bias,  accelerometer  scale  factor,  and  gravity  anomaly  effects. 

The  frequency  content  of  accelerometer  bias  induced  errors  (modulated  by 
earth,  transport  rates)  and  accelerometer  scale  factors  (modulated  by  aircraft 
vertical  maneuvers)  is  clearly  different  from  that  of  anomaly  induced  errors, 
and  should  therefore  allow  error  source  separation. 

The  critical  parameter  for  anomaly  observability  is  the  rms  vertical 
velocity  (and  altitude)  observation  error  resulting  from  smoothing  the  set  of 
measurements  obtained  over  the  anomaly  correlation  distance.  If  this 
parameter  is  smaller  than  the  anomaly  induced  error  in  equations  (-14),  then 
the  anomaly  is,  in  practical  terms,  an  observable  process,  and,  if  not  accounted 
for  in  the  filter  state  model,  will  lead  to  corrupted  estimation  solutions. 

The  gravity  errors  of  interest  are,  therefore,  the  vertical  deflections 
and  possibly  the  anomaly.  All  four  of  the  models  considered  in  Section  6. 8. 3.1 
provide  theoretically  consistent  statistics  for  these  three  error  states  and 
thus  constitute  potentially  acceptable  models  for  the  estimation  process.  As 
all  four  seem  to  provide  comparable  quality  fits  to  available  data  (gravity 
anomalies),  it  is  valid  to  wonder  whether  differences  between  them  are  of  any 
significance  for  the  EAR/GEANS  problem. 


Jordan  [39]  provides  a  comparative  evaluation  of  the  four  proposed 
gravity  deflection  models  in  terms  of  the  induced  steady-state  rms  position 
and  velocity  errors  of  an  externally-damped  inertial  navigator.  He  concludes 
that,  for  the  speed  regimes  of  interest  to  EAR/GEANS  (xg  =  Cg/v  <  .1  hr), 
there  is  no  appreciable  difference  between  the  various  model-induced 
performances.  The  differences  appear  at  process  correlation  times  which  are 
of  the  order  of,  or  larger  than,  the  Schuler  period.  This  differentiation 
would  appear  to  be  related  to  the  model's  "roundedness  at  the  origin",  i.e., 
whether  the  acf  derivat  ve  at  zero  shift  is  non-zero.  The  frequency  components 
which  contribute  to  a  non-zero  derivative  at  the  origin  would  appear  high 
frequency  (relative  to  Schuler)  at  high  vehicle  speeds  and  would  tend  to  be 
filtered  out  by  the  INS,  while  they  would  be  passed  at  low  vehicle  speeds. 

The  roundedness  at  the  origin  consideration,  compatible  with  intuitive 
physical  understanding  of  gravity  error  processes  as  resulting  from  the  local 
mass  distribution  of  the  earth,  would  tend  to  favor  the  K-2  and  J-3  models 
over  the  E  and  J-2  models. 

For  the  EAR/GEANS  estimation  problem,  however,  we  are  not  only  concerned 
with  the  steady-state  INS  response,  but  also  with  short-term  transient 
responses  observable  through  EAR  measurements.  The  cutoff  frequency  for  model 
differentiation  is,  therefore,  not  the  Schuler,  but  rather  that  frequency 
at  which,  given  the  EAR  measurement  rate  and  accuracy,  faster  induced  varia¬ 
tions  in  the  observable  variables  appear  white  to  the  estimator. 

Figure  13  plots  the  power  spectral  densities  (PSDs)  for  the  four 
involved  gravity  deflection  models  obtained  by  translating  the  space  domain 
acfs  to  the  time-domain  through  the  random  heading  maneuver  model  of 
Section  6. 8. 3. 1.2.  The  plots  present  normalized  PSDs  (G(u>)/o62  tg)  versus 
normalized  frequency  (u>^  =ujxg). 


N 

'E  = 

2a/(a2+toN2) 

E-model 

7C  Z 

1 

ro 

3  2  2  ^ 

=  4a  /(a  +wN  ) 

K-2  model 

,N 

'J-2 

=  a(a2+3wN2)/(a2+u>N2) 

J-2  model 

,N 

'J-3 

=  2a3(a2+5coN2)/(a2+u)N2) 

J-3  model 

where  a  =  cg/d,  d  =  model  characteristic  distance,  and 


1 

E-model 

2.146 

K-2  model 

0.6252 

J-2  model 

1.361 

J-3  model 

6-30 

(6.8-20) 


(6.8-21) 


a  = 


<v//l 


requency 


It  can  readily  be  seen  that  the  major  differentiation  between  the  models 
lies  in  their  high  frequency  content  (..  >>  1)  where  the  E-  and  J-2  models 
fall  as  1/u>n2,  while  the  K-2  and  J-3  models  fall  as  l/w^.  Consider  then  the 
spectra  as  a  series  of  individual  frequency  components,  and  recall  that, 
according  to  the  sampling  theorem,  two  observations  per  cycle  are  required 
to  identify  the  signal  component  (assuming  perfect  measurements).  The  ability 
of  the  Kalman  filter  to  recover-  any  frequency  component  above  ^  ~  4  (and 
thereby  to  differentiate  between  the  gravity  models)  depends  on  obtaining 
perfect  measurements  at  a  rate  of  8/ig.  Additionally,  as  measurements  will 
be  corrupted  by  random  noise,  smoothing  w'!Sl  be  required  to  bring  the  measure¬ 
ment  effective  random  error  to  a  level  comparable  to  the  observable  naviga¬ 
tion  error  induced  by  the  frequency  components  in  question.  As  the  effective 
measurement  rms  random  error  drops  as  the  square  root  of  the  number  of  measure¬ 
ments  smoothed  (i.e.,  l//n  ),  the  observation  rate  required  for  differentiation 
of  proposed  gravity  models  is  of  the  order  of  8k2/:q,  where  k  is  the  ratio  of 
measurement  rms  random  error  to  r.ho  gravity  induced' navigation  error  over  the 
time  of  interval  t  /8. 

These  considerations  are  similar  to  the  discussion  presented  above  in 
relation  to  observability  of  the  gravity  anomaly,  except  that  in  the 
deflection  case  we  are  concerned  with  observability  of  the  high  frequency 
portion  of  the  spectrum  rather  than  the  whole  of  it.  The  measurement  rate  and 
accuracy  (in  position  and  velocity  spaces)  expected  from  EAR  should  be 
evaluated  both  to  establish  the  anomaly  observability  and  to  provide  guidance 
as  to  the  deflection  model  selection.  Based  on  my  previous  experience  with 
doppler  radars  (Teledyne/Ryan  APN-200  type),  it  is  quite  likely  that  the 
combination  of  required  measurement  rate  and  accuracy  to  allow  filter 
differentiation  between  the  various  gravity  models  will  not  be  available, 
in  which  case,  selection  of  one  of  these  models  over  another  is  immaterial 
from  this  point  of  view.  Observability  of  gravity  anomalies,  on  the  other 
hand,  may  be  quite  possible  with  current  standard  technology. 


The  above  comparison  was  based  on  acf  transformation  to  the  time-domain 
through  the  random  heading  maneuver  model.  Application  of  this  same  analysis 
to  the  constant,  deterministic  heading  maneuver  model  is  hampered  by  the 
inability  to  find  closed-form  analytical  expressions  for  the  resultant  PSDs 
for  the  K-2  and  E-models.  The  argument  has  been  made  that  the  similarities 
noted  for  the  random  heading  maneuver  for  the  E-  and  J-2  models  and  for  the 
K-2  and  J-3  models  would  carry  over  to  this  maneuver.  However,  inspection 
of  the  acfs  (see  Table  3)  shows  that,  for  the  J-2  and  J-3  models,  the  acfs 
decay  exponentially  (as  dominant  mode)  while  the  E  and  K-2  model  acfs  contain 
terms  proportional  to  dvv?  t^  ,  which  decay  significantly  slower  than  any  of 
the  exponential  terms.  I  would  therefore  expect  that  the  E-  and  J-2  model  PSDs 
would  exhibit  larger  low  frequency  content  than  the  corresponding  PSDs  for 
the  other  two  models.  What  the  physical  significance  of  this  apparent 
behavior  is,  is  an  interesting  question. 


A  comparison  of  along-  and  cross-track  deflection  PSDs  for  the  J-2  and 
J-3  models  shows  a  similar  pattern  as  observed  for  the  random  heading 
maneuver;  that  is,  at  low  frequencies  they  are  similar,  while  at  high 
frequencies,  the  J-2  PSDs  fall  as  l/w^  while  the  J-3  PSDs  fall  as  l/io^.  In 


6-32 


addition,  in  both  cases,  the  along-track  component  PSD  significantly  differs 
from  the  cross-track  component  PSD  due  to  the  ratio  of  1:2  in  their  respective 
correlation  distances. 

The  turning  maneuver  represents  an  environment  which  is  not  easily 
represented  by  any  of  the  postulated  models.  The  situation  is  of  concern 
because  it  may  (again  depending  on  the  observability  afforded  by  EAR  measure¬ 
ments)  corrupt  estimation  of  GEANS  error  sources.  Consider  the  following 
heuristic  arguments:  a  turn  is  a  situation  where  the  actual  spatial  shift 
between  any  two  points  on  the  vehicle  track  is  smaller  than  would  be  inferred 
from  the  standard  r  =  v  t  transformation  (length  of  the  cord  versus  length  of 
the  arc).  Therefore,  the  true  correlation  between  deflections  at  the  two 
points  will  be  stronger  than  modeled,  and  the  induced  acceleration  error  will 
be  more  "bias-like"  than  that  represented  by  the  filter.  Part  of  this  effect 
will  therefore,  if  observed,  be  assigned  to  modeled  states  that  exhibit  more 
correlated  behavior  in  a  turn,  i.e.,  probably  to  accelerometer  scale  factors. 

The  extent  to  which  these  heuristic  considerations  represent  a  meaningful 
concern  bears  further  analysis  and/or  simulation. 

The  final  item  to  be  considered  relates  to  the  tracking  maneuver  discussed 
in  Sect.  6. 8. 3. 1.2  and  in  particular,  the  generation  of  an  harmonic  component 
in  the  gravity  error  spectrum  at  the  tracking  frequency.  This  effect  will  only 
be  of  concern  if  the  induced  harmonic  is  an  integral  fraction  of  one  of  the 
INS  oscillation  mode  frequencies  (i.e.,  Schuler,  24  hr),  in  which  case  it  may 
lead  to  miss-assignment  of  this  gravity  induced  error  to  one  of  the  corresponding 
GEANS  error  sources.  This  consideration  is  most  readily  laid  to  rest  by 
appropriate  flight  path  design. 


6. 8. 3. 2  Gravity  Error  Estimation 

The  recovery  of  gravity  errors  through  optimal  estimation  has  been  a 
singularly  unsuccessful  field.  Chatfield  et  al[43]  describe  one  such  attempt 
and  report  a  total  lack  of  success  in  estimating  gravity  deflections  from 
simulated  aircraft  flight  data;  yet,  their  measurement  rate  was  obviously  too 
slow  relative  to  the  estimator  model  correlation  times  to  expect  much.  Rose 
and  Nash [42 ] conducted  a  more  thorough  investigation  of  the  limiting  effects 
on  gravity  recovery  accuracy  and  the  sensitivity  of  the  results  to  the 
presence  of  modeling  errors  in  the  estimator  formulation;  yet,  their  results 
raise  as  many  questions  as  they  answer.  .. 

Rose  and  Nash's  configuration  consists  of  a  high-quality  military 
inertial  navigator,  position  and  velocity  reference  systems,  and  a  Kalman 
filter/smoother  that  optimally  combines  these  two  data  streams  and  attempts 
to  recover  the  values  of  the  encountered  gravity  deflections.  The  carrier 
vehicle  is  a  ship  straight-steaming  at  10  knots,  and  the  gravity  deflections 
are  modeled  as  second-order  Markov  processes. 

Rose  and  Nash  identify  as  the  first  deflection  recovery  limitation  the 
so-called  "bias  problem",  i.e.,  the  similar  frequency  content  of  low  frequency 
deflection  components  (i.e.,  "global"  terms)  and  position  reference  bias  error 


or  IMU  bias-like  instrument  error  sources.  Note,  however,  that  a  100  ft 
position  error  causes  the  "platform"  to  be  tipped  by  only  1  sec  (~6p/Re), 
and  thus  allows  observation  of  vertical  deflections  exceeding  this  value. 
Smaller  position  reference  bias  errors  will  result  in  correspondingly 
smaller  platform  tips,  so  this  effect  is  not  expected  to  be  significant  for 
EAR/GEANS.  If  correlation  with  IMU  error  sources  is  now  considered,  it 
should  be  noted  that,  as  discussed  in  Sect.  6,8.2,  their  error  signatures  are 
modulated  by  earth  rate  (and  aircraft  transport  rate)  and  thus  will  exhibit 
different  frequency  content  than  gravity  "bias"  errors.  For  the  highly 
stable  instrument  error  models  assumed  for  GEANS,  high  correlation  between 
these  states  should  not  develop.  The  conclusion  reached  in  this  paper  is 
thus  directly  resultant  from  the  large  (.06  nmi  ~  3.6  sec)  position  reference 
bias  and  the  fixed  orientation  between  IMU  instruments  and  gravity  deflections 
imposed  by  the  INS  mechanization. 

Rose  and  Nash  present  the  results  of  steady-state  covariance  analysis  of 
recovery  accuracy  sensitivity  to  system  parameters.  They  indicate  that  the 
primary  disturbances  are  the  position  reference  noise  and  the  vertical 
deflections  themselves.  This  conclusion  seems  plausible  enough,  at  least 
for  a  given  stability  of  IMU  instrument  error  sources.  However,  the  shape 
of  the  sensitivity  curves  (in  particular,  the  sensitivity  to  the  deflections 

(see  Figures  14  and  15))  and  the  limitina  values  reached  when  the  primary 
disturbances  tend  to  zero  would  seem  to  3e  dependent  on  the  particular  model 
assumed  for  the  rest  of  the  system  (i.e.,  INS).  The  paper  states  that  part 
of  the  accelerometer  bias  error  is  modeled  as  a  Markov  process,  although  the 
variance  and  correlation  time  are  not  specified.  If  this  correlation  time  is 
similar  to  that  of  the  deflections,  both  error  source  models  would  exhibit 
similar  frequency  content,  and  separation  of  their  effects  would  be  difficult. 
In  this  case,  reducing  the  rms  measurement  noise  improves  the  estimate  of  the 
1  inear  combination  of  error  sources,  but  not  particularly  of  the  error  sources 
themselves.  Also,  if  one  of  the  error  sources  in  the  linear  combination  is 
dominant  (i.e.,  much  larger  noise  power)  then  estimation  of  the  linear  combi¬ 
nation  is  approximately  equivalent  to  estimation  of  the  dominant  member;  as 
the  dominance  disappears  (decreasing  noise  power  of  dominant),  the  recovery 
accuracy  of  the  once-dominant  term  decreases  on  a  relative  basis  and  is 
eventually  limited  by  the  separability  problem.  This  consideration  may 
explain  the  shape  of  the  "sensitivity  to  rms  value  of  deflection  process" 
curve  presented  in  the  paper. 

The  authors  go  on  to  state  that  increasing  the  measurement  rate  beyond 
the  assumed  two  pe*-  gravity  deflection  correlation  distance  does  not 
materially  improve  the  deflection  estimates.  I  assume  that  they  mean  this 
statement  to  apply  at  their  standard  rms  position  measurement  noise  value  of 
.08  nmi  (i.e  ,  close  to  the  limiting  value  for  deflection  recovery  accuracy), 
since  taking  2n  measurements  of  rms  value  o  over  the  gravity  deflection  time 
is,  in  steady-state,  equivalent  to  taking  two  measurements  with  rms  value 
o//n,  and  the  deflection  recovery  accuracy  is  clearly  sensitive  to  the  rms 
value  of  measurement  noise,  as  shown  in  Figure  15  The  observed  insensi¬ 
tivity  to  measurement  rate  is  probably  a  result  of  the  presence  of  a  "bias- 
limited"  process,  i.e.,  one  which  is  not  diminished  by  averaging.  We  do 
not  believe  that  the  modeled  position  reference  bias  represents  such  an 
effect,  since,  based  on  frequency  content,  it  is  clearly  separable  from  the 
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time-varying  deflection  process.  Another  example  of  "bias-limited"  effects 
is  the  error  source  correlation  discussed  above  for  deflection  and  accelerometer 
bias  error  sources. 

Rose  and  Nash  present  a  further  investigation  of  recovery  accuracy 
sensitivity  to  modeling  errors  for  the  deflection  process  in  the  estimator, 
and  indicate  that  the  sensitivity  is  higher  to  mismodeled  process  variance 
than  to  incorrect  assumed  correlation  distances.  Again,  this  statement  seems 
plausible  enough  as  it  stands.  However,  the  presented  curves  should  be 
analyzed  in  light  of  the  utilized  measurement  rate  (two  per  filter  assumed 
correlation  distance).  The  plotted  results  for  the  sensitivity  to  correlation 
distance  modeling  errors  (See  Figure  16)  appear  flat  for  true  values  smaller 
than  assumed.  For  this  range  of  time  correlation  distances,  the  truth  model 
autocorrel ation  decays  faster  than  assumed  and  the  "truth"  filter  is  not 
satisfying  the  sampling  theorem  requirements.  Thus,  although  the  mismatched 
filter  is  incorrectly  weighting  the  information,  arid  should  produce  corrupted 
estimates,  the  standard  against  which  its  performance  is  compared  is  not 
capable  of  observing  the  deflection  process  because  its  sampling  rate  it  too 
low.  Furthermore,  the  effect  is  insensitive  to  further  reduction  in  true 
correlation  distance  since  the  deflection  process  already  appears  like  white 
noise  to  the  "truth"  estimator. 

In  summary,  it  would  appear  that  the  conclusions  reached  in  this  paper 
are  restricted  by  the  particular  assumed  system  configuration,  and  that 
extreme  care  should  be  exercised  in  attempting  to  extrapolate  these  results 
to  a  different  environment.  In  addition,  the  paper  does  not  cover  certain 
areas  of  interest  for  the  EAR/6EANS  problem,  such  as  modeling  and  estimation 
of  gravity  deflections  during  vehicle  turns.  On  the  other  hand,  it  does 
indicate  that  the  deflections  are  recoverable,  to  some  level_which,  for  the 
EAR/GEANS  application,  may  be  quite  better  than  the  5  to  8  sec  achieved  here. 

Conceptually,  therefore,  standard  Kalman  filtering  represents  a  possible 
technique  for  recovering  the  gravity  error  processes  and  removing  them  as 
disturbances  from  the  estimation  of  the  desired  EAR/GEANS  error  sources.  If 
externally  derived  sample  values  of  gravity  errors  are  available,  they  can 
readily  be  incorporated  in  this  structure  as  direct  measurements  of  the  modeled 
gravity  states.  The  utilization  of  non-stationary  gravity  processes  may  be 
necessary  in  the  estimator,  especially  during  vehicle  maneuvers;  the  structure 
of  such  non-stationary  models,  however,  is  still  to  be  derived.  But,  if 
properly  formulated,  the  Kalman  filter/smoother  will  provide  the  optimal 
(in  the  minimum  variance  sense)  solution  for  all  the  system  states,  including 
the  desired  EAR/GEANS  error  sources. 

A  simplifying  variation  on  the  above  fully  optimal  approach  may  be  of 
value.  The  largest  uncertainties  as  to  gravity  errors  are  related  to  short 
term  effects  (i.e.,  turns,  local  mass  distribution  of  the  earth,  etc.),  while 
longer  term  effects  have  been  accurately  mapped  by  DMA,  etc.  On  the  other  hand, 
the  high  stability  of  GEANS  error  sources  implies  that  a  leisurely  observation 
rate  may  "well  be  sufficient  for  their  recovery  [47].  We  can  therefore  consider 
updating  the  estimator  at  a  rate  which  is  slow  relative  to  the  local  gravity 
error  correlation  time  (say,  a  measurement  update  every  10  minutes),  thereby 
making  the  uncertain  gravity  effects  appear  like  "white  noise"  to  the  estimator 
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and  automatically  resolving  the  issue  of  modeling  the  gravity  field  time 
structure.  Of  course,  attendant  recovery  accuracy  penalties  will  be  pay, 
in  that  1)  short  correlation  time  processes  will  not  be  estimated  (EAR  error 
sources?),  and  2)  a  proportional  degradation  in  rms  recovery  accuracy  of  /n 
(less  if  process  is  "bias-limited")  will  be  encountered,  where  n  is  the  ratio 
of  the  measurement  rates  implemented  in  the  compared  processes.  If  these 
penalties  are  acceptable,  this  approach  may  obviate  the  concern  of  modeling 
the  local  fine-structure  gravity  processes.  Note  that  this  approach  does 
not  require  interference  with  the  rate  at  which  measurements  are  taken 
inflight,  but  only  with  the  rate  at  which  measurements  are  utilized  in  the 
post-flight  environment. 


6. 0.3. 3  Gravity  Error  Compensation 

Given  the  difficulty  of  modeling  gravity  errors  as  random  processes, 
and  the  availability  of  gravity  data  at  DMA,  we  may  consider  deterministically 
compensating  gravity  induced  errors  by  addition  of  a  suitable  "control"  term 
to  the  estimator  error  propagation  equations.  Even  if  some  residual  compensa¬ 
tion  error  remains,  the  magnitude  should  be  significantly  smaller  than  that 
of  the  whole  value  error,  and  the  estimator  sensitivity  to  modeling  errors 
should  be  proportionately  reduced.  Furthermore,  some  of  the  bothersome 
characteristics  of  the  whole  value  error  (such  as  non-isotropicity)  may  be 
largely  removed  by  the  compensation  process,  making  the  residual  errors 
easier  to  model. 

Traditionally,  deterministic  gravity  models  followed  the  spherical 
harmonic  expansion  approach,  with  coefficients  derived  from  observations 
of  satellite  orbits.  Such  models  are  generally  too  coarse  for  adequate 
representation  of  gravity  disturbances  in  the  areas  of  interest  to  EAR/GEANS. 


Of  greater  applicability  are  deterministic  models  fit  to  local 
data.  Chatfield  et  al[43]  describe  an  approach  where  a  replica  of  the  local 
gravity  field  is  constructed  as  a  combination  of  a  reduced  set  of  ellipsoid 
spherical  harmonics  and  a  potentially  large  number  of  subterranean  point 
masses  (acting  through  Newton's  mass-attraction  law),  which  best  fit,  in  a 
least-squares  sense,  observed  local  gravity  data.  A  highly  accurate  fit  is 
obtained  through  this  technique  (residual  rms  errors  of  the  order  of  .3  ugs 
are  reported);  however,  the  number  of  required  point  masses  (10722)  represents 
an  extreme  computational  burden.  The  computational  penalty  could  presumably 
be  reduced  by  loosening  the  quality-of-fit  requirement  (an  order  of  magnitude 
degradation  in  residual  rms  fit  error  is  probably  acceptable)  without 
significant  impact  on  EAR/GEANS  error  source  recovery  accuracy;  however,  the 
computation  cost  will,  in  all  likelihood,  still  be  high. 

Junkins  [44]proposes  the  utilization  of  local  approximating  polynomials, 
fit  by  regression  techniques,  to  represent  the  gravity  errors  over  a 
prespecified  geographic  cell.  The  clear  advantage  of  this  method  lies  in  that 
the  local  approximating  functions  are  much  simpler  than  global  expressions, 
due  to  the  significantly  reduced  geographic  area  over  which  they  are  valid. 
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Junkins  proposes  the  use  of  nth  order  Chebyshev  polynomials,  with 
coefficients  determined  by  least-squares  fitting  of  local  gravity  data, 
as  the  model  basis  functions,  since  he  finds  that  they  provide  a  uniform 
distribution  of  errors  over  the  cell  (i.e.,  homogeneous  isotropic  residual 
error  processes?) . 


Of  concern  in  this  approach  would  seein  to  be  selection  of  the  cell 
size  and  maximum  order  of  the  Chebyshev  polynomials,  as  representing  a  trade¬ 
off  between  computation  and  model  accuracy.  Junkins  [45]  presents  an  evalua¬ 
tion  of  the  model  as  a  function  of  these  parameters,  by  comparison  to  a 
point-mass  gravity  error  model  (model  310),  and  shows  rms  fit  error  of  less 
than  1  ug  for  1°  x  1°  cells  and  polynomial  maximum  order  3  (implies  approxi¬ 
mately  nine  polynomial  coefficients).  The  fidelity  of  the  cited  model  310 
to  the  fine  structure  of  the  gravity  field  is  not  known  to  me,  so  that  the 
relevance  of  these  quoted  accuracies  to  the  EAR/GEANS  problem  is  uncertain. 
Note  that  the  utilized  cell  dimension  is  significantly  larger  than  the 
correlation  distances  utilized  for  statistical  gravity  error  models;  it  is 
not  clear  to  me  how  the  higher  frequency  components  of  the  gravity  error 
processes  (which  may  be  important  for  EAR/GEANS)  can  be  approximated  to  that 
accuracy  with  that  few  coefficients. 

Still,  there  does  not  seem  to  be  any  reason  why,  with  suitable  selection 
of  cell  size  and  polynomial  order,  this  technique  cannot  represent  a  feasible 
approaci.  for  gravity  error  compensation  in  the  EAR/GEANS  problems.  The 
computational  burden  imposed  by  the  requirement  to  adequately  represent  those 
gravity  error  frequency  components  observable  to  the  filter  may  bear  further 
evaluation,  however. 


6.8.4  Recommendations  for  EAR/GEANS 

The  previous  section  presented  a  discussion  of  possible  modeling  and 
compensation  approaches  to  attempt  to  remove  gravity  errors  as  a  disturbance 
from  the  estimation  of  EAR/GEANS  sources  of  errors.  Based  on  that  discussion, 
we  now  present  some  guiding  concepts  and  recommendations  as  to  the  techniques 
to  be  used  in  this  problem. 


The  model  selection  decision  is  to  be  two- fold:  i)  what  model  is 
suitable  for  simulation  purposes,  and  11)  what  model  is  suitable  for  estima¬ 
tion?  These  two  decisions  are  not  independent.  Apart  from  the  fact  that  the 
simulator  model  should  at  least  be  as  faithful  to  the  real-world  environment 
as  the  filter  model,  it  is  also  important  that  any  lack  of  fidelity  of  the 
simulation  not  compensate  a  corresponding  inadequacy  in  the  estimator.  In 
particular,  you  have  suggested  the  use  of  the  J-3  model  for  simulation  and 
the  J-2  model  for  estimation.  On  the  positive  side,  both  models  are 
computationally  tractable,  and  the  simulation  model  is  more  involved  than  the 
estimator  model.  On  the  other  hand,  however,  we  must  note  that  both  models 
incorporate  the  same  incorrect  assumptions,  in  that 


1)  they  both  assume  isotropicity  of  the  anomaly  process, 

2)  they  both  yield  incorrect  statistics  during  aircraft  turns,  due 
to  the  assumed  r  =  vt  transformation  between  space  and  time 
domains. 


Given  the  importance  of  gravity  errors  in  this  problem,  I  would  strongly  urge 
that,  if  at  all  possible,  a  deterministic  gravity  model,  generated  by  fitting 
actual  data,  be  utilized  for  simulation  purposes.  The  utilization  of  such 
data  in  at  least  one  test  case  will  provide  some  confidence  that  the  formulated 
estimator  is  not  simply  tuned  to  the  simulation  model,  and  that  it  will 
successfully  accomplish  the  transition  to  the  real  flight  data  processing 
environment. 

When  utilizing  the  deterministic  gravity  model  for  simulation,  considera¬ 
tion  should  be  given  to  representation  of  model  residual  errors,  if  significant. 
It  is  believed  that  these  would  be  of  high  frequency  content,  arising  out  of 
gravity  measurement  errors  and  intersample  gravity  variations,  and  would 
therefore  be  suitably  represented  by  a  white  noise  model. 

The  estimator  should  include  the  deterministic  model  also,  if  computa¬ 
tionally  feasible.  If  not,  states  shall  have  to  be  allocated  to  this  error 
source.  Design  of  the  filter  state  model  should  consider  the  following 
points. 

•  For  the  GEANS  space-stable  mechanization  and  assumed  stability  of 
IMU  error  sources,  global  gravity  errors  are  probably  observable. 

Such  errors  should  be  compensated,  or  additional  states  shall  have 
to  be  included  for  them,  as  the  formulated  local  gravity  error 
models  do  not  support  a  bias  level. 

•  The  observability  of  gravity  anomaly  should  be  determined  for  the 
expected  EAR  vertical  velocity  measurement  rate  and  rms  random 
error.  If  observable,  it  should  be  included  in  the  state  model 
to  avoid  corrupting  estimation  of  "vertical"  accelerometer  error 
sources. 

•  If  the  gravity  anomaly  is  included  in  the  error  state,  it  should  be 
of  benefit  to  represent  the  cross-correlations  between  anomaly  and 
vertical  deflections.  In  this  case,  the  first-order  Markov  model 
you  suggest  as  possible  for  the  deflections  would  not  be  applicable. 

The  J-2  model,  for  which  an  appropriate  shaping  filter  has  been 
formulated,  would  seem  a  suitable  choice. 

•  For  any  selected  gravity  process  model,  the  formulation  of  estimator 
non-stationary  statistics  for  turning  maneuvers  should  be  considered. 
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6.9 


Synthesis  of  the  EAR/GEANS  Error  Isol  .it  ion  Filter 


This  section  comprises  Intermetrics  AFAL/GPS  Analysis  Memo 
#03-78,  "Filter  Synthesis  for  the  EAR/GEANS  Error  Isolation 
Filter,"  by  Lawrence  F.  Wiederholt,  dated  10  May  1978  [48]. 


6.9.1  Introduction 

This  memorandum  defines  the  filter  for  the  EAR/GEANS  Error  Isolation  Filter. 
The  focal  point  of  this  activity  is  the  state  vector  selection  which  involves 
two  major  subsystems:  the  GEANS  inertial  navigation  system  and  the  EAR  radar 
unit.  Since  the  performance  characteristics  of  the  GEANS  INS  are  better  known 
than  that  of  the  EAR  radar,  emphasis  in  the  state  selection  is  placed  on  the 
radar  unit  rather  than  the  INS.  Also,  since  the  error  characteristics  and 
performance  of  the  INS  are  well  known  and  understood,  the  related  state 
elements  and  corresponding  models  are  selected  with  considerable  confidence. 
Recommendations  for  state  elements  and  models  are  made  for  radar  but  their 
adequacy  must  be  verified  by  test  data  either  from  bench  measurements  or  flight 
data,  since  the  error  characteristics  and  performance  of  the  radar  are  less 
well  understood. 


This  niL-io  includes  and  is  organized  according  to  the  following  topics: 
INS  and  radar  measurement  state  vector  selection,  process  noise  covariance 
matrix  definition,  transition  matrix  evaluation,  initial  state  vector  and 
initial  covariance  matrix  definitions. 


6.9.2  State  Vector  Selection 

The  INS  state  vector  is  defined  first,  followed  by  that  for  the  radar  measure¬ 
ment.  The  INS  state  selection  starts  with  the  "truth"  model  defined  by 
J.  Burnsl23]  The  fundamental  matrix  derived  by  J.  Burns  is  included  here  in 

Figure  17  for  convenience.  This  is  an  error  state  formulation  in  the  inertial 
reference  frame.  The  object  is  to  develop  a  suboptimal  model  with  a  reduced 
state  vector  by  eliminating  states  from  the  truth  model  which  are  either  not 
observable  or  not  separable  for  the  expected  test  flight  trajectories .  All 
instrument  error  parameters  are  estimated  in  the  platform  frame  to  facilitate 
physical  interpretation  of  the  results. 

The  position,  velocity  and  tilt  errors  will  of  course  be  retained  as  filter 
states.  Starting  with  the  gyro  instruments,  some  reductions  are  possible.  In 
the  terms  driving  the  tilt  angle  error  states,  there  is  a  linear  combination 
which  cannot  be  separated  given  by 
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Figure  17:  (Contd.)  -  Additional  F-Matrix  Entries  for  Accelerometer  Error  Model 


The  terms  GBZ  and  GR+  cannot  be  separately  estimated  so  their  sum  defines  a 
new  variable. 


This  new  state  will  be  defined  as  a  random  constant 


The  remaining  gyro  terms  are  the  gyro  biases  GB j  and  the  g-sensitive  terms 
GFIj.  Comparing  their  magnitudes,  one  has 


0  a  (GBj  *  GF I j  f) 

GBj  =  10  3  deg/hr  (lo) 
GFI j  =  10'3(deg/hr)/g  (la) 
f  3  lg  (gravity) 


0  a  (10'3  +  10'3) 


The  two  terms  are  of  comparable  magnitude,  therefore  both  terms  will  be 
retained.  Since  for  the  space  stable  platform,  gravity  does  not  align  with  any 
one  axis  during  a  flight,  all  the  GF I j  terms  must  be  retained. 

This  concludes  the  gyro  instrument  parameter  selection.  The  gyro  biases  and 
g-sensitive  terms  are  the  only  gyro  error  sources  included  in  the  state  vector. 

Next,  the  accelerometer  parameters  are  considered.  All  the  accelerometer 
misalignment  states  will  not  be  estimatable  unless  an  accurate  attitude  reference 
is  available  which  is  not  the  case  here.  So,  the  y-axis  and  the  x-y  plane  are 
chosen  as  an  accelerometer  reference,  eliminating  the  states  AMXy,  AMY x ,  and 
AMYZ.  This  leaves  AMXZ,  AMZX,  and  AMZy  as  the  accelerometer  misalignment 
states.  This  reference  selection  does  redefine  platform  tips  and  gyro  misalign¬ 
ments,  which  is  of  neglectible  consequence  here. 

The  remaining  accelerometer  error  terms  are  significant  enough  to  retain. 

The  accelerometer  error  terms  are  of  comparable  magnitude  which  for  a  2g 
specific  force  is  illustrated 


6V  a  (ABI  +  ASFj  f  +  AMIj  f)ak. 

=  (50  gg  ♦  50  x  1 0*6  2g  ♦  50xl0‘6  2g)aki 
=  (50  g  +  100  g  +  lOOg)  x  10'6  aki 

The  comparable  magnitudes  of  all  terms  plus  the  inability  to  make  any  other 
particular  assumptions  leads  to  retaining  all  the  remaining  terms.  This 
concludes  the  state  selection  for  the  INS. 
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The  next  subsystem  considered  is  the  baro-al timeter .  J.  Burns  in  Ref.  [29] 
has  proposed  four  states  to  represent  the  baro-al timeter.  Since  a  detailed 
knowledge  of  the  performance  of  the  baro-al timeter  is  not  of  interest,  a 
reduction  to  a  single  state  modeled  as  a  random  walk  was  considered,  i.e.. 


where  wg  represents  the  combined  effects  of  the  error  in  the  Blanchard-computed 
algorithms  with  perfect  data,  error  due  to  dynamic  lag,  error  due  to  temperature 
measurement  and  error  due  to  static  pressure  measurement,  all  of  which  are 
separately  modeled  in  J.  Burn's  model .  The  impact  of  this  single  state  model 
is  that  the  process  noise  covariance  for  wg  is  large  to  include  all  the  error 
effects  and  a  correlated  model  for  5hg  has  been  replaced  with  an  uncorrelated 
model  (white  noise).  The  baro-al timeter  model  effects  both  the  altitude  error 
ah  and  vertical  velocity  error  6V?  which  are  directly  driven  by  the  baro  error 
state.  This  relationship  is  shown  in  the  steady  state  expressions  derived  by 
P.  Grundy  [23],  Eq.  (6.3-3)  of  this  report. 


<5hss  =  a  3Az  +  b  6hg 


«SVz  =  c  6A?  +  d  5h 


where  a,  b,  c,  d  are  constant  coefficients  based  on  the  vertical  channel  gains 
and  Schuler  frequency,  5A  is  the  vertical  acceleration  error. 

A  degradation  of  3h  and  5VZ  by  6hg  effect  the  ability  to  estimate  the 
vertical  acceleration  error  term  ,5  A  - .  This  effect  must  be  analyzed  before  the 
single  state  model  can  be  used  for  the  baro  error  state.  For  representative 
values,  the  Shg  terms  dominate  the  5hss  value  whereas  the  i5VZs<.  value  has 
significant  contributions  from  both  the  $AZ  and  'hg  terms  which  is  shown  as 
fol lows. 

From  Ref .[  24  ], 


C-|  =  0.01/sec 

C2  =  2.81  x  10"5/sec2 

C4  =  1 
ws"  =  g/R 
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CT6h  =0e2  +0C?  Vh2+0C2  h2+0C2  lV|4 

°nB  eBA  °DL  n  LTP  LSP 

»  (900  +  83.61  +  10,000  +  1589)m2 


2  iri4  2 

otl,  =1.3x10  m 

6hB 


o.  =  50  ug 


2  2  2  .  .  2  2 

hss  '  °AZ  °hB 

a.2  =  407  +  1.3  x  104  s  1.3  x  104  *  b2  o.D2 
hss  hB 

2  2  2  2  2 

aVzs  "  c  aAZ  d  °hB 

=  4  x  10'2  +  1 .9  x  10‘2 


Therefore,  the  6hss  is  approximated  by 


6hs$  s  b  5hB 

Although  6ho  and  6AZ  are  coupled  to  measurements  of  6h  and  6V,,  6hg  is  almost 
entirely  determined  from  6h  measurements  and  5AZ  is  determined  principally 
from  6VZ  measurements  given  6he. 

Given  a  large  white  noise  model  for  6hg,  the  ability  to  estimate  6AZ  is 
analyzed  using  j  steady  state  covariance  analysis.  The  error  covariance 
equation  is  given  by 

P  =  F  P  +  PFT  +  Q-  KRK1 
K  =  P  HT  R_1 
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(Using  the  same  value  Qg  for  both  velocity  and  position  measurements  assumes 
that  they  occur  at  the  same  frequency.  Even  though  velocity  measurements 
occur  more  frequently,  it  does  not  effect  the  conclusion.) 

If 


1  40  m 

QB  1  1 . 3  x  1 04  m2 
oy  *  1  m/sec 

then 


4560  m 


2 


=  7.1  x  10‘7 


(m/sec2) 


2 


or 


JAZ 


=  =  8.4  x  10~4  m/sec 


-5  2 

But  values  are  expected  to  be  on  the  order  of  10  ug  (9.8  x  10  m/sec  ). 
So  filtering  both  6h  and  6VZ  measurements  leads  to  a  steady  state  uncertainty 
which  is  larger  than  the  expected  values  of  the  quantity  estimated  6AZ  which 
says  that  6AZ  cannot  be  estimated  with  a  white  noise  model  for  ShB  of  this 
magnitude. 


The  second  effect  analyzed  is  the  impact  of  modeling  6hg  as  an  uncorrelated 
white  noise  when  in  fact  it  is  a  correlated  process.  Neglecting  this  correla¬ 
tion  results  in  its  effect  biasing  the  estimate  of  6AZ.  This  bias  can  be 
computed  using  a  steady  state  analysis  on  the  state  estimates 


x  =  Fx  +  K(z  -  Hx) 
K  =  P  HT  R*1 


Then 


b 

d 
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which  is  a  significant  bias  compared  to  the  expected  values  of  <5A2.  Therefore 
considering  the  estimation  accuracy  and  bias  of  6A2  with  Shg  as  a^white  noise, 
it  can  be  concluded  that  this  is  an  unacceptable  model  for  5hp.  It  is  realized 
that  this  is  a  steady  state  analysis  and  the  actual  performance  will  differ 
from  this,  but  this  analysis  is  indicative  of  the  performance  expected  and  it 
is  adequate  to  support  the  conclusion. 

On  the  other  hand,  each  element  of  Burns'  model  is  separately  estimated  and 
as  each  parameter  is  observed,  its  uncertainty  diminishes.  The  result  being 
that  the  linear  combination  of  parameters  to  form  <5hg  has  a  decreasing  uncertainty 
that  permits  an  accurate  estimation  of  the  .SA^  term. 

So  the  conclusion  is  that  a  single  random  walk  state  model  for  6hp  is 
inadequate  here  and  the  four  state  model  proposed  by  Burns  should  be  used.  This 
conclusion  assumes  that  the  elements  of  the  four  state  model  are  observable  so 
that  the  covariance  of  the  linear  combination  becomes  less  than  that  of  the 
process  noise  covariance  of  wg  for  the  single  state  model.  An  alternative  to 
estimating  all  four  elements  would  be  to  retain  only  the  epA  and  eCyp  terms  and 
include  the  ecpL  anc*  eCSP  term  in  the  Q  matrix  for  Shb.  This  conclusion  can  be 
drawn  from  the  relative  magnitudes  of  the  terms  in  above  and  the  expected 

variation  in  each  term  (V  will  not  change  significantly  over  a  flight). 

The  next  subsystem  addressed  for  state  vector  selection  is  the  radar  and  its 
measurements.  Several  significant  errors  are  identified  which  can  be  categorized 
as  follows: 

1)  Errors  in  the  orientation  of  the  antenna  in  inertial  space 

2)  Errors  caused  by  electromagnetic  propagation  of  the  radar  transmissions 
through  a  non-ideal  medium,  such  as  refraction  and  multipath 

3)  Inherent  radar  measurement  errors 

4)  Survey  errors  in  the  checkpoint  locations 

These  error  sources  can  be  modeled  as  follows. 

The  antenna  orientatiory  error  in  inertial  space  has  three  sources  as 
identified  in  Refs.  [31]andL^9  J.  They  are  the  tilt  angles  of  the  platform  6i , 
included  as  part  of  the  INS  error  state;  platform  to  case  errors,  u,  (or  qimbal 
angle  errors,  e i ) ;  and  antenna/random  errors,  t.  These  three  error  sources 
contribute  to  the  velocity,  elevation  and  azimuth  measurements. 

Two  observations  are  made.  First,  note  that  the  four  gimbal  angle  errors, 

(ei,  e2.  63,  e^)  cannot  all  be  observed  because  one  is  redundant.  Second,  if 
the  results  of[31]  and[50]  are  used  where  the  angle  errors  have  all  been  trans¬ 
formed  to  the  navigation  and  inertial  frames,  respectively,  the  t  and  p  terms 
cannot  be  separated  if  the  same  dynamic  model  is  used  for  each.  Recalling  that 
the  measurements  have  a  term  of  the  form  (gi  +  t*  +  this  can  readily  be 
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2  T 

seen  from  the  standard  definition  of  observability,  i.e.,  [H,  H$,  Hi  1  has  two 
identical  columns.  On  the  other  hand,  if  either  different  dynamic  models  are 
used  for  t_  and  y_  or  x  and  are  defined  in  different  coordinate  frames  with  a 
time-dependent  transformation  between  frames,  t  and  ^  are  separately  observable. 
This  is  illustrated  as  follows.  If  y  is  coord Tnati zed  in  the  platform  frame 
and  called  ^P  and  t  is  coordinatized  in  the  case  frame  and  called  ic,  the 
measurement  term  referred  to  above  becomes 

.  -i  C  .  _i  P. 

(£  +  Cc  t  +  Cp  ^  ) 

where 

i  i  P 

Cc  3  Cp  Cc  transformation  from  case  to  inertial 

C1  =  transformation  from  platform  to  inertial 
P 

p 

Cc  =  transformation  from  case  to  platform 


p 

The  transformation  Cc  contains  the  gimbal  angles  which  will  be  time  varying 
thus  making  and  uP  separately  observable  in  the  theoretical  sense.  In  a 
practical  sense,  the  azimuth  component  may  be  the  only  separable  component  of 
yP  and  tC  because  a  heading  angle  will  typically  be  held  for  a  sufficient  period 
of  time  to  permit  this  component  to  be  larqe  relative  to  the  smoothed  measurement 
noise.  The  duration  of  pitch  and  roll  will  typically  be  short  term,  therefore 
making  it  difficult  to  observe  and  separate  these  components  of  tc  and  yP. 


To  get  to  the  final  selection  of  angular  errors,  it  can  be  shown  that  the 
third  component  of  jC  forms  a  non-separable  linear  combination  with  ed.  Starting 
with  the  error  in  the  transformation  from  antenna  to  inertial  C]  from[49]leads 
to  the  term  in  the  measurements 


,A  x  /-i  C  .  ** i  P, 
(£  +  Cc  I  +  cp  \L  ) 


referenced  above. 

This  term  is  equal  to 

,A  .  ri,rP  C  .  P,« 

(£  +  cp(cc  T  +  H  )) 

where  we  will  work  only  with  the  term 
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.p  C  F 
y  t  +  u 


in  platform  frame  since  Cp  is  common  to  both 


Then  from  Ref. [31] 


where 


. 


P  cgl 

rg2  cg3 

Cg4 

gl  g2 

Cg3  g4 

c 

c04 

S04 

O' 

I 

l/* 

O 

X* 

c04 

0 

0 

0 

1 . 

:‘s)  are 

defined 

in  1 

Ref.  [49],  they  are 

repeated  here. 

Then,  from  Ref.  L49] 


S' 


0 

sO-j 

C0.jC02 

sG^Gj  -  C0j  SGjCOj 

e 

0 

cGj 

-C02s0j 

cO-jSG,  +  SO^C03S02 

1 

0 

S02 

Ct^CGj 

or 


Then 


Mp  *  Cgl  Ae- 


CP  t  +  MP  =  CP,(C91  C9^  C9j  C94  r  +  Ae) 
c  c  M  gl '  g2  g3  g4  c  c 


Working  this  out,  one  has 


(  )t1  ♦  (  )t2  +  (  )e1  ♦  (  )e2  +  (  )e3  +  (sOjSGj  -  cO1sO3c03)(t3  +  e4) 
(  )t1  ♦  (  )t2  +  (  )e1  +  (  )e2  ♦  (  )e3  +  (cO^Oj  +  sQ1sO2c03)(t3  +  e4) 
(  h,  +  (  )t2  ♦  (  )e]  +  (  )e2  ♦  (  )e3  +  (c2  c3)(x3  +  e4) 


From  this  expression,  one  can  see  the  nonseparable  linear  combination  of 
(T3  +  e4)*  Redefine  this  sum  to  be 


t3  +  e4 


Then 


t  +  (Cgl  Cg2  Cg3  cg4  t ' ^  +  A  e) 

C  Tc  u  Lgll  92  g3  g4  Lc  T  A  e  ' 


where 


A 


0  sOj  cO^Og 

0  C01  -COjSO^ 

1  0  S02 
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iwMtf 


k-\ *.  ....  — — > 


or 


rP  C  .  P  rP  *C  A  B  ' 
Cc  t  ♦  p  *  Cc  t  +  B  e 


where 


B  = 


c01  +  S01  (cO]  -  so^  )cO.> 


/T 


/r 


C0-|  -  S0j  (cG^  +  SOj  )c0, 

,T  7F~ 


SO. 


which  is  the  first  three  columns  from  Figure  3  in  Ref.  [49]. 
So,  the  transformation  error  term  becomes 


(S1  +  cj  xC  +  cj  uP)  =  (0<  +  t’C  ♦  C*  B  e') 


\ 

l  +, 


'C  ' 

t  and  e  will  be  included  in  the  state  vector  to  represent  the  case  to 
antenna  and  gimbal  angle  errors  respectively,  keeping  in  mind  that  the  third 
component  of  t'C  includes  the  fourth  gimbal  angle  error  e/j.  From  Ref.  {.49] 
t'C  and  e'  can  be  modeled  as  random  constants 


'  'C 

t  L  «  0 


Initially,  all  six  components  will  be  included  in  the  state  vector,  but 
the  simulation  studies  may  indicate  that  the  roll  and  pitch  related  components 
are  not  separately  observable,  recalling  the  practical  observability  discussion 
above. 

For  the  radar,  range,  range-rate,  and  monopulse  azimuth  and  elevation 
measurement,  errors  are  included.  The  radar  errors  on  range  3R  and  range  rate 
6ft  are  modeled  as  biases 
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—  6R  =  0 
dt 


The  residual  propagation  effects  after  compensation  are  not  included  as 
elements  in  the  state  vector  but  rather  its  effect  should  be  treated  as  an 
additive  white  noise  to  the  radar  measurements. 


The  justification  for  this  selection  is  as  follows.  It  is  assumed  that 
at  least  the  average  propagation  effects  over  a  large  geographic  area  will  be 
removed  by  the  compensation  in  the  radar.  The  propagation  error  remaining 
then  will  be  only  the  local  variations  from  the  average,  primarily  near  each 
checkpoint.  This  residual  should  be  small  in  magnitude  assuming  a  reasonable 
compensation  algorithm.  Since  the  aircraft  is  moving  relative  to  the  check¬ 
point,  the  residual  propagation  error  from  measurement  to  measurement  will 
probably  uncorrelate  making  its  estimation  difficult.  Therefore,  they  are 
included  as  a  random  additive  noise  to  the  measurements  rather  than  states  to 
be  the  estimated.  On  the  other  hand,  the  radar  biases  will  remain  constant 
independent  of  aircraft  motion,  location,  or  checkpoint.  Therefore,  these 
biases  should  be  recoverable.  The  adequacy  of  the  constant  model  proposed  for 
5R  and  6ft  must  be  verified  by  test  data. 

The  monopulse  azimuth  and  elevation  measurement  errors  included  are  a  bias 

and  scale  factor  error.  The  monopulse  system  assumes  a  linear  relation  between 

the  ratio  of  difference  to  sum  signal  ( A/E )  and  the  measured  angle  which  for 

measured  elevation,  E  ,  is  given  by 

m 


E 


m 


A  similar  relationship  holds  for  azimuth.  This  relationship  is  valid  for 
small  differences  A.  The  error  effects  modeled  in  this  process  are  that  of  a 
bias  in  this  relationship  which  corresponds  to  A  being  zero  but  Em  not  equaling 
zero  and  a  scale  factor  error  which  corresponds  to  an  error  in  the  slope  K. 

The  error  in  an  elevation  measurement  can  then  be  written  as 


AKP  E  +  E. 
Em  b 


where 

ake  =  aK, 
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MMlMMHi 


A<1  3  error  in  the  elevation  slope 
Efa  *  elevation  bias 


Similarly  for  the  error  in  the  azimuth  measurement 


AKfl  A  +  A. 
Am  b 


where 


*A 


AK^  3  error  in  the  azimuth  slope  KA 


A.  =  azimuth  bias 
b 


The  models  assumed  for  these  error  quantities  are  random  constants 


ake  =  0 

Eb  =0 
AKa  -  o 

ea  =0 

Again,  the  adequacy  of  these  models  must  be  verified  by  test  data. 

These  error  terms  for  range,  range  rate,  azimuth  and  elevation  add  directly 
to  the  radar  measurements  for  purposes  of  forming  the  H  matrix  and  residuals 
in  the  filter. 


The  survey  errors  of  the  checkpoint  can  be  modeled  as  random  constants 


I 


and  6X,  5Y,  and  <5Z  represent  the  three  cartesian  components  of  a  survey  error. 

The  ability  to  estimate  survey  errors  depends  on  the  number  of  measurements 
taken  from  the  same  checkpoint.  A  reasonable  number  of  measurements  from  the 
same  checkpoint  and  at  different  aircraft  locations  are  required  for  the  filter 
to  estimate  the  survey  error.  If  survey  error  states  are  included,  either 
states  for  each  checkpoint  are  included  or  filter  rectification  on  checkpoint 
switching  is  required.  Also,  one  checkpoint  must  always  be  chosen  as  a  reference 
from  which  other  checkpoint  survey  errors  are  measured.  It  is  reconinended  that 
survey  errors  be  included  in  the  state  only  if  frequent  measurements  to  each 
checkpoint  from  different  aircraft  locations  are  taken. 

This  completes  the  filter  state  selection.  The  suboptimal  filter  state  is 
summarized  in  Table  4. 


Table  4 

Suboptimal  State  Vector 


5rix 

x  cartesian  position  error  in  inertial 

space 

5riy 

y  cartesian  position  error  in  inertial 

space 

5riz 

z  cartesian  position  error  in  inertial 

space 

6Vsx 

x  velocity  error 

6Vsy 

y  velocity  error 

6Vsz 

z  velocity  error 

*ix 

platform  angular  error  about  x  axis 

6iy 

platform  angular  error  about  y  axis 

*iz 

platform  angular  error  about  z  axis 

ABX 

x  accelerometer  bias 

ABY 

y  accelerometer  bias 

ABZ 

z  accelerometer  bias 

ASFX 

x  accelerometer  scale  factor  error 

ASFY 

y  accelerometer  scale  factor  error 

ASFZ 

z  accelerometer  scale  factor  error 

AMX 

z 

x  accelerometer  misalignment  about  z  axis 

AMZ 

X 

z  accelerometer  misalignment  about  x  axis 

AMZy 

z  accelerometer  misalignment  about  y  axis 

GBX 

x  gyro  bias 

GBY 

y  gyro  bias 

GZR 

z  gyro  bias  and  torquing  error 
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Table  4 


(Contd. ) 


GFX 


g  sensitive  drift  of  x  gyro  about  x  axis 


GFX 

2 

GFY 

> 

GFY2 

GFZ 

i 

GFZ; 

eBA 

CDL 

CTP 

CSP 

A 

T2 


5R 

6R 


g  sensitive  drift  of  x  gyro  about  z  axis 

g  sensitive  drift  of  y  gyro  about  y  axis 

g  sensitive  drift  of  y  gyro  about  z  axis 

g  sensitive  drift  of  z  gyro  about  y  axis 

g  sensitive  drift  of  z  gyro  about  z  axis 

blanchard  algorithm  error  in  baro  altimeter 

dynamic  lag  coefficient  in  baro  altimeter 

standard  temperature  error  coefficient  in  baro  altimeter 

standard  pressure  error  coefficient  in  baro  altimeter 

antenna  misalignment  about  case  x  axis 

antenna  misalignment  about  case  y  axis 

antenna  misalignment  about  case  z  axis 

angle  error  in  gimbal  #1 

angle  error  in  gimbal  #2 

angle  error  in  gimbal  #3 

radar  range  bias 

radar  range  rate  bias 

monopulse  elevation  scale  factor  error 


Ek 


monopulse  elevation  bias 
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Table  4  (Contd. ) 


monopulse  azimuth  scale  factor  error 


Ab 

monopulse  azimuth  bias 

6X 

x  axis  survey  error 

6Y 

y  axis  survey  error 

5Z 

z  axis  survey  error 
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6.9.3  Process  Noise  Covariance  Matrix 


The  process  noise  covariance  matrix  Q  reflects  the  system  driving  noises 
and  accounts  for  unmodeled  and  neglected  effects.  Unmodeled  effects  considered 
for  inclusion  in  the  Q  matrix  are  the^gyro  misalignment  terms  and  the  gyro 
gZ-dependent  drift  terms.  The  gyro  g^-'dependent  drift  terms  are  represented 
in  general  by 


a  fj  fk  GmJk 


which  exist  only  for  j  t  k. 

Starting  with  the  general  form 


0 


/  * 


N  ds  let  $  *•  1 


then 


.  „  ^  ft2,2 

i  GFF1jk  J  J  1 


ds  ,  j  t  k 


In  particular,  from  Eqn.  (6-21)  of  Ref.  [29], 


2 

01  °GFFX  j 

xy  J 

0 

V 

y 

+  °gffxX2  j 

l\2 

y 

f  - 

y 

L 

+  1’gffx  J 

yz  */ 

f  f  2  f  2 
r  y 

V 

a  °GFFY  j 
xy-/ 

w 

f 2 

y 

+  °GFFY  1 
xz  J 

<\ 2 
X 

y 

f; 

*  "gf'fy  .  J 

yz  J 

f  2  2 

f  f  ^ 
y  z 

2  i 

f  9 

f  p 

y 

y  , 

°L,i: 

a  °GFFZ  / 
xy  J 

f  i 

X 

f  * 

y 

*  °GFF l  J 

XZ 

f c 

X 

f  c 

*  °GF>Z  J 

'  f*  ^ 

An  expression  is  required  for 


where  a  and  b  take  on  the  values  x,  y,  and  ;,  and  a  *  b. 
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Let 


then 


f2  -  f  2  +  f  2 
a  b 


'' ;  V 


'  *  <2VJ'"'abl>‘ 


where 


V  =  1 /  V  2  +  V.  *■ 
ab  »  a  b 


4Vab  ■  *  V  •“ 


Making  this  substitution  in  the  equations  above,  one  has 


2  n 
Qn  ^  ^rrrv  C  ..  + 


Bi,  “  °GFFXxv  V  *  °»FF*  ,  °«  4  Cyl 


xy 


Vv  "  °GFFYxy  Cxy  *  °GFFYx;,  C»r  *  °GFFYyJ  Cy; 


xz 


V  “  °GFFZxy  cxy  *  0GFFZM  Cx;  *  °gffz  cy.- 


where 


Cxy  *  <  W 

Cxx  *  <2V«„I) 


cyy  '  <V4V>‘ 


xy 


V  * 
xz 


V 

V  v,2  ♦  V,2 


2  2 

V  /  +  V  c 
x  y 


6-b4 


V 

V77 

+  V 

2 

yz 

1  y 

z 

AV  = 

At  ^ 

'f  2 

+ 

f 2 

xz 

X 

z 

AV  = 

At  V 

f  2 

f 2 

xy 

X 

y 

AV  = 

At  1 

+ 

f  2 

yz 

X 

z 

The  gyro  misalignment  terms  which  have  also  been  neglected  are  given  from 
Eqn .  ( 6-1 5)[ 29 ]  as 


8j  *  c;  *9 


which  in  general  is  given  as 


6Cn  uin  = 

g  ip 


GSF 

-XG 

XG 

X 

y 

z 

YG 

X 

GSF 

y 

-YG 

-ZG 

ZG 

GSF 

X 

y 

iP 


where 


GSF  u  7  dre  torquing  scale  factor  errors  and  the  other  terms 


x  *y « z 


represent  the  misalignments 


u).^  is  the  angular  velocity  of  the  platform  in  inertial  space 


For  the  space  stable  system  with  no  platform  torquing  ui.jj  =  0.  The 
process  noise  matrix  term  becomes  simply  p 


v° 
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6.9.4  Transition  Matrix  Evaluation 

The  transition  matrix  4>  can  in  general  be  represented  as 


f  Fdt 

4>  =  e 

for  a  system  described  by  x  =  F  x  +  u. 

<t>  can  be  approximated  as  a  Taylor  series  retaining  the  first  two  terms. 


4>  =  I  +  /  F  dt 


the  second  order  terms  are  assumed  neglectible. 

The  evaluation  of  /  F  dt  depends  on  how  rapidly  F  varies.  The  following 
forms  are  used 


/  Fdt 


F  At 


<Fi+i +  Fi^¥ 


for  slowly  varying  F 

(trapezoidal  integration)  for  rapidly 
varying  F 


The  rapidly  varying  terms  are  usually  just  the  specific  force  related  terms, 
for  which  the  integrals  Av  =  J*  Fdt  are  available  from  the  IMU. 
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6.9.5  Initial  State  Vector  and  Covariance  Matrix 


The  probability  distributions  of  all  elements  of  the  state  vector  are 
symmetric  about  zero.  Therefore,  the  expected  value  of  the  state  vector,  given 
no  measurements,  is  zero 

*0  "  E[^]  *  0 

The  variances  of  the  horizontal  components  of  position  and  velocity  error 
can  be  initialized  to  sufficient  accuracy  by  considering  the  simplistic  error 
model 

6p  3  6vB  *NAV  +  («vs/ws)s1n(Ws  tNAV  ♦  *) 

6v  =  6vb  +  <5vs  cos  (u)$  tNAV  +  $) 

where 

6vB  *  bias  velocity  error 

6v  *  amplitude  of  the  Schuler  oscillation 
ws  =  Schuler  radian  frequency 
^NAV  s  t’me  s’nce  ^S  was  switched  to  nav  mode 
♦  1  random  phase  of  Schuler  oscillation 


oVB  ■  2  f/sec 
°VS  "  5  f/sec 


The  cross-correlation  implied  by  this  crude  model  is  ignored  on  conserva¬ 
tism  grounds. 

The  second  order  vertical  channel  will,  in  steady-state,  drive  the  alti¬ 
tude  error  to  the  linear  combination  of  baro-al ti tude  error  and  vertical 
acceleration  error,  in  order  to  zero  the  ra te-of-change  of  vertical  velocity. 
Additionally,  in  order  to  zero  the  ra te-of-change  of  altitude,  the  vertical 
velocity  will  exhibit  an  error  which  is  proportional  to  the  vertical  accelera¬ 
tion  error  and  baro-al ti tude  error  as  is  illustrated  in  Ref. [23]  and  presented 
above.  So,  in  the  local  level  frame  we  have  a  four  element  vector  which  we 
can  consider  for  this  initial  covariance  definition  given  by 


Cov  X  ■  E[X  X  ]  - 


p  c  p 

3h  ohfiV 


PSh<Shg  P,Sh,sA. 


where,  assuming  6hg  and  6Az  are  independent, 


P6V,6hn  P6V„6 A, 

4.  b  «.  Z 


6hn6A 

z 


9  0  0  0  0 

P6h  *  a  P6AZ  +  P<5hp 

=c^P  ^  ♦  d*-  P 
6VZ  c  \SA,  a  \$hp 
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S  °eBA  +  °CDC2  ^  *  °CTP^  ^  +  °CSp2  IVI4 

( from 
eq. 

P6A_  "  K  0dR72 


P6h6V  =  a  c  P5A2  +  bd  P  2 
2  6h0 

P5h6hB  S  b  P^?R 


6h<5A  =  a  p< 


\%  ■ d  p% 


6V.6A 


=  c  P, 


■  0 


Where'  Ref.  [291,  Eq.  (3), 


l+c,  ca 
a  =  - J  4 


c2  *  2w$  (HCl  c4) 


.  b 


C2  '  2ws  (1+ci  c4) 


where 


c2  -  ?“s‘n*c,  c4) 


,  d  = 


2w  r 
s  C1 


C2  '  2ws  ^1+cl  c4) 


c,.c2,c3  =  vertical  channel  gain  parameters 
ws  3  Schuler  frequency  g, 7$) 

K  *  scale  factor  multiplier 
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This  defines  the  initial  uncertainties  and  correlations  for  the  vertical 
channel  related  terms. 

The  platform  tips  may  be  assumed  to  be  related  to  the  Schuler  oscillation 
6p  given  above  as 


6  »  6P/R 


then 


V  ‘  Ns  “s/9>2 

e 


The  azimuth  error  is  related  to  the  initial  gyro-compassing  error,  in  addition 
to  the  subsequent  azimuth  gyro  drift  rate 


P8Z  =  (2oG8X/nc0sL)  +  (°GBZ  tNAV^ 

where  it  has  been  assumed  that  the  platform  is  aligned  with  the  x  axis  east 
and  ft  =  earth  rate,  L  =  latitude.  These  initial  covariance  values  for  the 
position,  velocities  and  tips  are  referenced  to  the  local  level  frame  which 
should  be  transformed  to  the  inertial  frame  for  use  by  the  EIF. 

The  instrument  error  covariances  (accelerometer  and  gyro)  are  initialized 

wi  th 


where 

o.  =  instrument  standard  deviation  (accelerometer  and  gyro) 
1  e.g.,  I  =  GBX,  GBY,  GBZ, 

K  =  scale  factor  multiplier 


The  same  form  is  used  for  the  gimbal  angle  error  and  antenna  misalignment 
initial  covariance. 
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The  initial  covariance  for  radar  error  states  are  defined  in  a  similar 
manner. 


P  «  o2  K 

e 

2 

where  o  is  taken  as  the  system  specification  for  each  measurement  type. 


6.9.6  Conclusion 

The  filter  has  been  formulated  for  the  EAR/GEANS  error  isolation  filter. 
This  formulation  has  included  the  filter  state  vector  selection,  process  noise 
covariance  matrix  definition,  transition  matrix  evaluation,  initial  state 
vector  and  covariance  matrix  definitions.  The  state  vector  elements  and  models 
for  the  INS  are  well  defined  but  the  state  vector  elements  and  models  for  the 
radar  are  less  well  understood  and  will  require  validation  using  test  data. 
Gravity  errors  have  not  been  considered  here  since  they  are  the  topic  of  a 
separate  memo.  The  filter  algorithm  and  measurement  matrices  are  also  the 
topics  of  separate  memos. 


6.9.7  Subsequent  Refinements 

Subsequent  to  the  initial  definition  of  the  E IF  state  vector  presented 
in  Ref.  [48]  and  repeated  in  Section  6.9.2,  a  few  instrument  error  states 
have  been  deleted,  some  modified,  and  others  added.  Those  deleted  are  baro- 
altimeter  dynamic  lag  error,  monopulse  elevation  and  azimuth  scale  factor 
errors,  and  radar  checkpoint  x,y,z  survey  errors.  Those  changed  are  monopulse 
elevation  and  azimuth  angle  biases  to  cosine  biases.  Those  added  are  radar 
range-rate  scale  factor  error,  and  three  gravity  perturbation  components.  The 
current  EAR/GEANS  E IF  state  vector  is  defined  in  Section  6.10,  Table  6 
of  this  report . 
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6.10  Feedback  Correction  Equations  for  EAR/GEANS  EIF 


This  section  and  Appendix  A  comprise  Intermetrics  AFAL/GPS 
Memo  #79-01,  "Feedback  Correction  Equations  for  EAR/GEANS  EIF," 
by  Neal  A.  Carlson,  dated  31  May  1979  [51]. 

6.10.1  Introduction  and  Summary 

The  EAR/GEANS  onboard  navigation  filter  can  operate  in  either  a  feed¬ 
back  or  feedforward  mode.  As  described  in  Reference 52 ] the  feedback  mode  is 
the  normal  operating  mode;  however,  the  system  operator  can  switch  from  one 
option  to  the  other  as  he  chooses.  A  system  status  bit  indicates  which 
mode  is  being  used  at  any  given  time. 

In  the  feedback  mode,  all  13  onboard  filter  states  are  utilized  to  cor¬ 
rect  the  INS,  altimeter,  and  antenna  subsystems.  The  feedback  correction  is 
completed  on  all  13  states  within  one  1/32  sec  computation  cycle,  and  so 
indicated  by  an  event  flag.  This  flag  is  recorded  at  8  Hz  on  the  flight 
data  tape;  hence,  it  is  possible  post-flight  to  determine  the  time  of  feed¬ 
back  correction  to  within  +  1/16  sec. 

During  post-flight  data  analysis,  the  Error  Isolation  Filter  (EIF) 
determines  running  estimates  of  the  errors  in  several  components  of  the 
onboard-computed  EAR/GEANS  state,  plus  estimates  of  a  sizeable  number  of 
system  error  sources.  Certain  EIF  error-state  estimates  must  be  adjusted 
each  time  an  onboard  feedback  correction  is  encountered,  to  account  for  the 
discrete  jump  in  the  onboard  state. 

The  remainder  of  this  memo  describes  the  theoretical  basis  for  feedback 
correction  compensation  in  the  EIF;  the  relationship  between  EAR/GEANS  cor¬ 
rection  components  and  EIF  error  states;  and  the  feedback  compensation 
equations  actually  implemented  in  the  EIF. 


6.10.2  Theoretical  Background 


Certain  EIF  error-state  elements  must  be  adjusted  each  time  an  onboard 
feedback  correction  is  encountered;  other  EIF  error-state  elements  are 
independent  of  the  onboard  state,  and  require  no  adjustment.  This  section 
describes  the  general  process  whereby  EAR/GEANS  onboard  state  corrections  are 
implemented  and  these  corrections  are  compensated  in  the  EIF.  For  purposes 
of  discussion,  the  following  definitions  are  convenient: 

x  =  EAR/GEANS  indicated  state 

<5x  *  onboard  filter  computed  error  in  x 

s  s  EIF  reference  system  state 

e  *  EIF  best  estimate  of  error  in  S 

s  =  S  -  e,  EIF  best  estimate  of  system  state 

()'  =  value  just  before  onboard  correction 

()+  =  value  just  after  onboard  correction 

When  the  EAR/GEANS  onboard  navigation  filter  is  operating  in  the  feed¬ 
back  mode,  it  periodically  corrects  the  indicated  state  as  follows: 

x+  *  x"  -  fix'  (6.10-1) 

<5x+  =  0 

That  is,  the  filter-computed  error  6x  is  subtracted  from  the  indicated 
state  x,  whereafter  the  error  is  reset  to  zero.  For  purposes  of  post-flight 
analysis,  the  onboard  system  records  the  correction  as 

6x  =  6x"*S  x‘-x+  (6.10-2) 

During  post-flight  processing,  the  EIF  maintains  a  best  estimate  s  of 
the  true  system  state.  This  estimate  is  maintained  in  two  parts,  a  reference 
or  nominal  value  5  and  a  best  estimate  e  of  the  error  in  that  reference 
value: 
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e 


(6.10-3) 


s  ■  |  - 

This  relationship  by  definition  remains  unchanged  when  the  onboard  filter 
applies  discrete  corrections  5x  to  the  onboard  state  x.  Hence,  the  estima¬ 
ted  error  e  must  be  adjusted  to  compensate  for  discrete  changes  in  the 
reference  state  s,  or  in  the  estimated  true  state  s,  resulting  from  the 
onboard  correction  5x. 

The  adjustment  £e  to  the  EIF  error  state  required  to  compensate  for 
an  onboard  correction  <5x  can  be  defined  by 

e+  *  e'  -  5e 

is '  ( !!  •  #i* 

\  dx  ax  / 

That  is,  an  adjustment  6e  is  required  in  any  EIF  error  state  element  for 
which  either  i)  the  reference  value  s^  is  derived  directly  from  the  current 
onboard  state  x,  or  ii)  the  true  value  -  estimated  as  s^  -  is  actively  con¬ 
trolled  by  the  onboard  system  as  a  function  of  x  or  6x?  No  adjustment  is 
required  in  an  error  state  for  which  iii)  the  reference  value  5^  is  derived 
independently  of  the  current  onboard  state,  and  the  true  value  is  unchanged 
by  the  onboard  correction. 

All  three  cases  are  possible  in  principle.  For  the  EAR /SEANS  EIF.  most 
of  the  error  states  related  to  the  onboard  correction  fall  in  category  i), 
and  a  few  fall  in  category  iii).  Careful  examination  of  variable  definitions, 
onboard  correction  mechanisms,  and  EIF  reference  data  construction  is  neces¬ 
sary  to  determine  the  proper  relationships.  These  factors  are  examined  in 
detail  in  Section  6.10.3. 

A  potential  further  complexity  arises  when  the  EIF  error  state  is 

available  at  some  time  t  not  identical  to  the  feedback  correction  time  tf. 

e  i 

# 

Example:  true  attitude  of  in  inertial  platform  actively  torqued  to  correct 
for  filter-computed  tilts. 


(6 . 10-4) 
(6.10-5) 


6-  ~  4 


The  compensation  valid  at 
state  transition  matrix  i 


tf  must  be  propagated  from  t^ 
before  the  EIF  error  state  at 


to 


t  via  the  EIF 
can  be  corrected: 


5§f  =  A  5Xf 

?e+  ■  ee'  -  <*■( te . tf)5ef 


(6.10-6) 


In  the  present  mechanization  of  the  EIF,  the  error  state  e  is  propagated 
explicitly  to  each  EAR/GEANS  feedback  correction  time,  such  that  t  =  t^; 
hence,  the  compensation  can  be  applied  directly  as  per  Eqs.  (6.10-4,5). 


3 •  ReJ ationship  of  Feedback  Correction  States  to  EIF  Error  States 

The  EAR/GEANS  feedback  correction  6x  comprises  13  elements,  defined  in 
Table  5.  The  EIF  error  state  e  comprises  4;  elements,  defined  in  Table 
o.  The  relationships  Detween  the  elements  of  5x  and  the  elements  of  e  are 

represented  by  the  44  x  13  matrix  A  in  Eq. ( _ 5 ).  To  determine  these  rela- 

* 

tionships  requires  careful  examination  of  the  definitions  of  corresponding 
elements  of  each  state  space.  Details  of  these  relationships  are  presented 
in  the  following  four  subsections. 


For  sake  of  clarity,  the  specific  coordinate  frames  in  which  vectors 
are  represented  are  indicated  by  superscripts: 

(  =  inertial  (space-stable)  coordinates 

(  )P  1  GEANS  platform  coordinates  (nominal  accelerometer  and  gyro  input 
axes) 

(  )r  =  GEANS  rotated  platform  frame 
(  )n  -  GEANS  navigation  frame 
(  )c  =  GEANS  gimbal  case  frame 
(  )a  =  EAR  antenna  frame 

Coordinate  transformations  C  from  one  frame  to  another  are  indicated  by 
corresponding  subscript  and  superscript,  e.g.. 
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Table  5 

Definition  of  EAR/GEANS  Feedback  Correction  States 


Elements 
of  6x 

Math 

Symbol 

Description 

Coord. 

Frame 

Units 

1-3 

2 

Corrected  error  in  onboard  components 
of  space-relative  velocity  v^ 

Inertial 

m/s 

4-6 

Sr1 

Corrected  error  in  onboard  components 
of  geocentric  position  r 

Inertial 

m 

7 

6hB 

Corrected  error  in  onboard  Blanchard 
altimeter  bias  Ahg 

None 

m 

8-10 

64> 1 

Corrected  error  in  platform-to-inertial 
rotation  vector3  equivalent  to  Cp 

Inertial 

r 

11-13 

6aC 

Corrected  error  in  case-to-antenna 
rotation  vector  equivalent  to  C* 

Case 

r 

Notes:  1.  Definitions  derived  from  [52],  pp.  4-29  to  4-32 

2.  Corrected  error  is  amount  subtracted  from  the  onboard  state, 
i.e.,  minus  the  change  in  onboard  state. 

Rotation  vector  equivalent  to  coordinate  rotation  matrix  (Appen 
dix  A). 


3. 


r 


Table  6 

Definition  of  EAR/GEANS  Error  Isolation  Filter  States 


Elements  Math 


of  e 

1-3 

4-6 

7-9 

10-12 

13-15 

16-18 

19-21 

22-27 

28-30 

31-33 

34-36 

37-39 

40-41 

42-44 


Symbol 


AEr 

ASFP 

AMX2 

AM2X 

AM2Y 

GB^ 


RB 

RRB 

RRSF 


Description 

Error1'  In  onboard  geocentric  postion 
vector  r 

Error  in  onboard  inertial  (space-relative) 
velocity  vector  ys 

Error  in  onboard  platform-to-inertial 
rotation  vector'*  equivalent  to  C ^ 

Accelerometer  biases 
Accelerometer  scale  factor  errors 

*1  M 

(>  accel ‘ r  misal i gn ’ ts  about ( *  >  axes 
Gyro  bias  drift  rates 


axes 


Error  in  onboard  Blanchard  algorithm  bias 
Altimeter  temp. -induced  scale  factor  error 
Altimeter  static  pressure  coef.  error 

Error  in  initial  onboard  antenna-to-case 
coord,  rotation  vector  equiv.  to  c£0 

Errors  in  onboard  gimbal  angles  Pj 

Radar  range  bias 

Radar  range-rate  bias 

Radar  range-rate  scale  factor  error 


Coord. 

Frame 


Un  i  t  s 


GFXX 

X 

x’ 

GFX2 

X 

f 

GFYY 

y 

gyro  drift  sensitivities 

y 

GFY? 

GF2Y 

y 

t 

to  specific  force  along 

< 

y 

GF22 

i 

t 

{•«}  Monopu1se  {elevation}  cos1ne 

eg*  Error  in  onboard  gravitational  accel'n 
vector  ge  at  given  postion 


Inertial 

m 

Inertial 

m/s 

Inertial 

r 

Platform 

2 

m/s 

Platform 

NO 

Platform 

r 

Gyro 

r/s 

Gyro 

m/s 

None 

m 

None 

ND 

None 

m 

1 

Case 

[m/s)Z 

r 

Gimbal 

r 

None 

None 

None 

m 

m/s 

ND 

None 

NP 

Earth- 

fixed 

m/sZ 

Notes:  1.  Definitions  derived  from  [53,54,55] 

2.  Error  equals  indicated  value  minus  true  value 

3.  Rotation  vector  equivalent  to  coordinate  rotation  matrix  (Appendix  A) 
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How  this  correction  is  implemented  in  the  onboard  system  is  not  fully  under¬ 
stood  at  this  time[54].  For  present  purposes,  we  assume  that  the  onboard 
filter  maintains  an  altimeter  bias  term  Afig,  used  to  generate  corrected 
baro  outputs  fig  from  the  raw  readings  fig  as 

fig  *  hg  +  Afig  (6. 10-11) 

We  also  assume  that  the  filter-computed  altimeter  correction  6fig  is  applied 
to  this  bias  term, 

Afig+  *  Afig  -  6fig  (6.10-12) 

such  that  the  corrected  bias  value  can  be  applied  to  all  raw  baro  outputs 

hg  processed  before  the  next  filter  cycle.  Note  the  EqsZ6. 10-11, 12)  are 

consistant  with-10),  if  fi*  is  interpreted  as  the  adjusted  reading  that  would 

B  , 

have  been  obtained  with  the  old  bias  value  Afig  ,  and  fig  as  the  adjusted 

6fig 

is  manifest  as  a  jump  in  the  sequence  of  adjusted  baro  readings  fig. 

We  further  assume  that  the  onboard-adjusted  baro  reading  fig  (rather 
than  the  unadjusted  reading  hg)  is  recorded  for  post-processing  purposes. 

The  EIF,  then,  utilizes  the  onboard-adjusted  value  hg  as  the  reference  value 
from  which  the  best  estimate  of  barometric  altitude  is  computed  as 

hg  3  fig  -  e ( 28 )  -  other  EIF  error  terms  (6.10-13) 

where  e ( 28 )  represents  the  residual  Blanchard  algorithm  bias  error.  The 

sequence  of  true  baro  altitude  estimates  h  should  not  jump  when  an  onboard 

B 

correction  occurs.  Hence,  the  EIF  altimeter  bias  error  state  must  be  adjusted 
to  compensate  for  onboard  corrections  to  the  sequence  of  reference  values  fig: 

Ae(28)  *  Afig  -  5x(7)  (6.10-14) 


reading  actually  obtained  with  the  new  bias  value  Afig.  That  is. 
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6.10.3.3  Platform  Tilt  Correction 


Elements  8-10  of  the  feedback  correction  6x  comprise  small -angle  cor¬ 
rections  to  the  platform-to-inertial  transformation  matrix  C’  computed  by  the 
onboard  system.  This  transformation  from  GEANS  platform  to  inertial  coor¬ 
dinates  is  maintained  as  the  product  of  two  rotations  [26,  p . 3 ] : 


ei  =  cic:  (6.10-15) 

P  rp 

where  £’  represents  a  rotation  of  approximately  90°  about  z,  and  Cj"  is  a 
r  P  * 

very  slowly  varying,  near-unit  matrix.  In  the  notation  of  [52,  p.4-3]. 


(6.10-16) 


The  EAR/GEANS  onboard  filter  corrects  in  a  fashion  equivalent  to  the 
following  procedure  [52,  p .4-30) : 


=  (I  + 


(6.10-17) 


where  *  represents  the  cross-product  operator,  and  6^  is  the  platform  tilt 
correction  in  inertial  coordinates.  More  specifically,  is  the  rotation 

from  the  uncorrected  (p-)  to  the  corrected  (p+)  platform  frame  (see  Appendix 
A).  This  correction  angle  comprises  elements  8-10  of  the  feedback  correction 
6x: 


6x(8,9,10)  ^  fij1 


(6.10-18) 


The  EIF  utilizes  the  onboard-computed  value  of  Cp  as  the  reference 


* 

The  order  D^j  given  in  [521  is  incorrect,  and  should  be  reversed  [54]. 


value  from  which  the  true-value  estimate  Cp  is  computed  [52,  p.5-2]*: 

Cj  =  (lV*)Cj  (6.10-19) 

where 

61  =  e(7,8,9)  (6.10-20) 

Here,  g1  represents  the  inertial  components  of  the  angular  error  of  the 
onboard-computed  platform-to-inertial  coordinate  rotation  cV  More  speci¬ 
fically,  6  represents  the  rotation  of  the  true  platform  frame  p  relative 
to  the  onboard-computed  platform  frame  p  (see  Appendix  A). 

The  true  platform  attitude  does  not  change  as  the  result  of  an  onboard 

correction,  since  the  GEANS  platform  is  not  physically  torqued.  Hence,  the 

true-value  estimate  remains  unchanged,  and  a  discrete  jump  in  the  refer- 
i  P  j 

ence  value  Cp  must  be  compensated  by  a  corresponding  adjustment  to  P  . 

From  Eqs.  (-17)-(-20),  this  adjustment  can  be  determined  equal  to 

Se(7,8,9)  =  661  =  &£'  *  6x(8,9,10)  (6.10-21) 


6.10.3.4  Antenna  Misalignment  Correction 

Elements  11-13  of  the  feedback  correction  5x  comprise  small-angle  cor¬ 
rections  to  the  onboard  transformation  from  navigation  frame  to  EAR 
antenna  coordinates.  The  onboard  system  maintains  C*  as  the  product  of  two 
rotations  relative  to  the  gimbal  case: 

cj  =  C*  cj;  (6.10-22) 

The  onboard  system  computes  the  antenna  orientation  C^  relative  to  the  case 
in  terms  of  a  misalignment  a  relative  to  its  nominal  orientation  C*Q.  This 
misalignment,  expressed  in  case-frame  coordinates  as  aC,  is  used  to  compute 

Ref.  [1]  has  error  in  sign  of  6:  should  be  plus  not  minus  [55]. 
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the  case-to-antenna  transformation  as  follows  [52,  p.4-31 1: 

£c  =  Cco(I  '  iC*5  (6.10-23) 

Here,  ac  represents  the  rotation  of  the  onboard-computed  antenna  relative  to 
its  nominal  orientation,  as  viewed  from  the  case  (see  Appendix  A).  The  on¬ 
board  filter  maintains  a  cumulative  estimate  of  gC,  and  periodically  corrects 
it  as 

gC+  =  gC'  -  <$aC  (6.10-24) 

_  c 

where  6a  is  the  antenna  misalignment  error  (angle  from  corrected  to  uncor¬ 
rected  antenna  frame)  comprising  elements  11-13  of  the  onboard  correction 

<5x: 

<5x(ll,12, 13)  =  5gC  (6.10-25) 

The  EIF  utilizes  as  its  reference  state  the  initial  value  C!"  of  the 

ao 

onboard-computed  antenna-to-case  transformation  [54],  The  EIF  best  estimate 
of  this  transformation  is  computed  as  [52,  p.5-2]* 

Cc  =  (I  +  x0*)^ 
a  v  -  '  ao 

where 

Tc  -  e ( 31 ,32,33) 

Here,  tc  represents  the  case-frame  components  of  the  angular  error  in 
the  initial  value  of  the  onboard-computed  antenna-to-case  transformation 
Specifically,  t  represents  the  angular  rotation  of  the  true  antenna  frame 
relative  to  the  initial  onboard-computed  antenna  frame,  as  viewed  from  the 
case  (see  Appendix  A). 

The  true  antenna  attitude  does  not  change  as  the  result  of  an  onboard 

it 

Ref.  [52]  has  error  in  sign  of  t:  should  be  plus  not  minus  [551. 


(6.10-26) 


(6.10-27) 
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correction,  nor  does  the  Initial  value  of  the  onboard-computed  antenna  at¬ 
titude.  Since  the  onboard  correction  affects  neither  the  true  state  nor  the 
EIF  reference  state,  no  adjustment  to  the  corresponding  EIF  error  states  is 
required: 


6e(31 ,32,33)  =  6xC  =  0  (6.10-28) 

(Note  that,  if  the  current  value  of  the  onboard-computed  transformation 

-  c  c 

C  were  used  as  the  EIF  reference  value,  then  the  EIF  error  state  t  would 

a  • 

require  adjustment  to  compensate  for  each  onboard  correction  6ac  to  that 

sequence  of  reference  values  C^.  In  this  event,  the  required  adjustment 
c  — c  a 

would  be  <5t  =  -6a  .) 


6.10.4  Feedback  Correction  Equations  for  EIF 


The  following  equations  summarize  the  adjustments  in  the  EIF  error 
state  e  required  to  compensate  for  feedback  corrections  6x  introduced  by  the 
EAR/GEANS  onboard  filter: 


Inertial 

velocity 


e(4,5,6)+  =  e(4,5,6)*  -  6x(l,2,3) 


(6.10-29) 


Inertial  . 

position  e(l ,2,3)  =  e(l,2,3)'  -  6x(4,5,6)  (6.10-30) 


Blanchard 
al time ter 


e(28)+  =  e(28)“  -  6x(7) 


(6.10-31 ) 


Platform 

tilt 


e(7,8,9)+  =  e(7,8.9)‘  -  5x(8,9,10) 


(6.10-32) 


Antenna  + 

misalignment  e(31,32,33)  =  e ( 31 ,32,33)”  [no  change] 


(6.10-33) 


These  adjustment  equations  form  the  basis  for  subroutine  *  I NSCNT *  in  the 
EAR/GEANS  EIF.  Subroutine  ' I NSCNT 1  is  called  by  'FPROP'  to  reset  the  appro¬ 
priate  E I F  error  state  variables,  to  account  for  feedback  corrections  applied 
by  the  onboard  filter. 
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6.11  FjiJ  ter/ Smoot  her  Mechanization  Equ at  i  ons  for  EAR/ GE  ANS  EIF 

This  section  and  Appendix  B  comprise  Intermetrics  AFAL/GPS  Memo  *79-02, 
"Filter/Smoother  Mechanization  Equations  for  EAR/GEANS  EIF,"  by  Neal.  A. 
Carlson,  dated  31  May  1979  [56]. 

6.11.1  Introduction 

The  forward  pass  of  the  EAR/GEANS  Error  Isolation  Filter  (EIF)  imple¬ 
ments  an  optimal  filter,  for  forward-successive  state  estimates  based  on 
all  past*  data  generated  by  the  onboard  system.  The  backward  pass  of  the 

EAR/GEANS  EIF  implements  both  an  optimal  filter,  for  backward-successive 

* 

state  estimates  based  on  all  future  data  generated  by  the  onboard  system, 
and  an  optimal  smoother,  for  backward-successive  state  estimates  based  on 
all  past  and  future  data  generated  by  the  onboard  system. 

The  forward  and  backward  optimal  filters  are  implemented  as  Kalman 
filters  in  triangular  square  root  form  f 57 , 58] The  optimal  smoother  is  im¬ 
plemented  as  a  Fraser  two-filter  smoother[59]  also  in  triangular  square 
root  form  [5  7] . 

This  memo  describes  i)  the  conventional  covariance  formulation  of  the 
optimal  filter  and  two-filter  smoother;  ii)  the  triangular  square  root  for¬ 
mulations  of  the  optimal  filter  and  two-filter  smoother  actually  implemented 
in  the  EIF;  and  iii)  potential  improvements  based  on  more  recent  develop¬ 
ments  [  60  ,  61  ]  . 

6.11.2  Notation 

b  unweighted  optimal  gain  vector  Ph 
dk  kth  diagonal  element  of  D 
D  diagonal  matrix  factor  of  P 
e  vector  UTh 

E  unitary  triangular  matrix  factor  of  Q 


f  vector  S^h 

h  measurement  gradient  vector  32/9x^ 
k  index 

n  dimension  of  filter/smoother  state 
P  state  error  covariance  matrix 
Q  process  noise  covariance  matrix 
r  variance  of  random  measurement  noise 
R  inverse  covariance  square  root  matrix  S'1 
S  triangular  matrix  square  root  of  P 
kth  column  of  S 

§  propagated  square  root  matrix  $S 
t  time 

U  unitary  triangular  matrix  factor  of  P 
Uk  kth  column  of  U 

0  propagated  unitary  matrix  factor  4-U 

V  unitary  triangular  matrix  factor  of  Q 

W  triangular  matrix  square  root  of  Q 
x  state  vector  estimate 
5  actual  measurement 
2  predicted  value  of  measurement 
A2  measurement  residual,  actual  minus  predicted 
a  variance  of  measurement  residual,  h^Ph  +  r 
f  state  transition  matrix 

()'  values  at  time  t' ,  prior  to  time  propagation 
()+  values  after  measurement  incorporation 
()b  backward  filter  variables 
Of  forward  filter  variables 
()  smoother  variables 


6.11.3  Conventional  Covariance  Formulation 

The  conventional  covariance  filter  propagates  the  state  estimate  x 
and  covariance  P  from  time  t‘  to  t  =  t’  +  At  as  follows: 
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6.11.4  Triangular  Square  Root  Formulation 


The  EAR/GEANS  E I F  implements  the  triangular  square  root  formulations 
of  the  optimal  filter  and  two-filter  smoother.  These  formulations  provide 
excellent  numerical  precision  and  stability  with  near-optimum  computational 
efficiency^?  ,58]  They  are  based  on  the  square-root  factorization  of  the 
state  error  and  process  noise  covariance  matrices: 

P  =  SST;  S  =  P'J 

t  l  (6.11-6' 

Q  =  WW1 ;  W  =  (P 

wnere  S  and  W  are  upper  triangular  (zero  below  main  diagonal).  The  covar¬ 
iance  square  root  S  and  state  estimate  x  are  propagated  from  time  t'  to 
t  =  t'  +  At  as  follows. 


4>  =  *(t,t'  ) 
W  =  W(t.t') 


(6.11-7) 


§  =  $S’ 

[S  0]  =  [S  W]  R 
x  =  4>x' 


(6.11-8) 


where  R  represents  the  Householder  triangulari zation  procedure  (Appendix  B). 
Scalar  measurements  ?  at  time  t  are  processed  as: 


i  =  «(x,t) 
hT  =  3z  /  3x 
r  -  r(t) 

M  =  i  -  i 


(6.11-9) 
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— • 


f  =  S'h 


ao  =  r;  ^0  =  9 

♦  f 2 


ak  1  ak-l 


\  •  6k-i  *  Vk 

5l+  =  "  &|c_i  f^  /  aL_i ) 


-k 


k-1 


n 


k-l 


x+  =  x  +  b  a  AZ 
-  -n  n 


“  k 


(6.11-10) 


k  =  l-*n 


where  Sk  represents  the  kth  column  of  S,  and  and  bk  contain  zeros  below 


the  kth  elements. 


The  two-filter  smoother  combines  the  forward-filter  covariance  square 
root  Sf  and  state  x^-  with  the  backward-filter  values  Sb  and  x^,  to  form  the 
smoothed  covariance  square  root  S$  and  state  x$: 


Rf  ■  v1  i  «b  ■  v' 

[rT  0]  .  tRfT  R„T]  R 

Ss  -  Rs-' 

x$  =  SsSs^  (Rf^RfXf  x  Rj  Rb-b^ 


where  again,  R  represents  an  orthonormal  Householder  tri angul arization 
matrix  (Appendix  B). 


6.11.5  Potential  Improvements 

The  triangular  square  root  filter  in  factored  form  [60,61],  is  the  most 
efficient  yet  stable  formulation  of  the  optimal  linear  filter  currently 
available.  The  filter  covariance  matrix  P,  triangular  square  root  matrix 
S,  and  matrix  factors  U,D  are  related  as  follows: 
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(6. 11-12) 


p  *  ssT  =  u  d  uT 

\s  K 

P5  =  s  =  U  D- 

The  triangular  matrix  U  comprises  a  normalized  version  of  S  having  unit 
diagonal  elements,  and  the  diagonal  matrix  D  contains  the  squared  normali¬ 
zation  factors.  The  process  noise  covariance  matrix  can  be  similarly  fac¬ 
tored: 


Q  =  WWT  =  VEVT 

‘s  Hi 

cr  =  w  = 


(6.11-13) 


Time  propagation  of  the  covariance  factors  U,  D  and  state  estimate  x 
from  time  t'  to  t  =  t‘  +  At  can  be  performed  as  follows: 


<t>  =  $(t,t'  ) 
V  =  V  ( t ,  t '  ) 
E  =  E(t.t') 


(6.11-14) 


U  =  *U' 

[UDS  0]  =  [UD^  VE1  K 
x  1  fix' 


where,  again,  R  represents  the  Householder  triangularization  procedure. 
(There  is  currently  no  existing  Householder-1  ike  algorithm  to  perform  the 
factored  operation  implied  by  (-lb)  such  that  square  roots  of  O'  and  E  are 
unnecessary.  However,  an  algorithm  of  this  type  is  under  development  [be'].) 
Scalar  measurements  i  at  time  t  are  processed  as: 
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(6.  n-i6) 


i  1  *  (  X  .  t ) 
hT  *  3«/3x 
r  1  r  ( t ) 
te  -  i  -  i 


e  =  u  Tm 

ao  =  r;  =  ? 
ak  *  ak_1  +  ek2dk 

bk+=  bk.!  ♦  ^  ekdk 

V  =  ^  -  bk-l  ek  >  a 


i 


dk  =  dk  cik-1  '  ak 
i+  =  ?  +  bn  an_1  A* 


k-1 


k  =  l-*-n 


(6.11-17) 


Note  that  Eqs.  (-17)  are  very  similar  to  Eqs.  (-10),  but  provide  a  computa¬ 
tional  savings  of  n  square  roots  and  approximately  n-/2  multiplies  per 
measurement  l ncorporation. 


The  two-filter  smoother  in  principle  can  be  performed  in  factored 
square-root  form.  However  ,  as  in  the  filter  time  propagation  phase,  there 
is  currently  no  Householder-like  algorithm  for  performing  the  trianqular- 
ization  of  Eqs.  (-11)  directly  in  factored  form  without  square  roots. 


6 .  ll.o  Recommendations 

The  triangluar  square  root  filter  and  smoother  algorithms  currently  im¬ 
plemented  in  the  EAR/GEANS  EIF  constitute  the  recommended  formulation. 

These  algorithms  are  nearly  the  most  efficient,  and  are  the  most  stable, 
formulations  of  the  optimal  linear  filter  and  smoother. 

A  modest  increase  in  computational  efficiency  is  possible  by  using  the 
U,D  factored  form  of  the  triangular  measurement  update  algorithm.  However, 


6-  M 


this  efficiency  increase  is  not  sufficient  to  warrant  recoding  and  retesting 
the  Elf  measurement  incorporation  routines.  Householder  triangularization 
routine,  and  optimal  smoother  routines,  furthermore,  the  Householder 
triangulari cation  and  smoother  algorithms  are  somewhat  more  complex  and  less 
efficient  in  factored  form;  no  direct  factored-form  algorithms  are  cur¬ 
rently  available  to  perform  those  functions. 


6-92 


APPENDIX  A: 


COORDINATE  ROTATION  MATRICES,  VECTORS,  AND  ERRORS 

A  rotation  or  transformation  from  one  coordinate  frame  to  another  can 
be  represented  by  several  different  but  equivalent  mathematical  forms.  Two 
of  these  forms,  the  coordinate  rotation  matrix  and  the  coordinate  rotation 
vector,  are  related  as  follows: 


C 


b 

a 


exp('-ab*) 

1  *  <§aV>  +  2l(SaV>2 


3!<?aV^  - 


(A-l ) 


where 


« 


A 

=  matrix  coordinate  rotation  form  frame  a  to  b 
A 

=  vector  rotation  from  frame  a  to  b,  coordinati zed 
in  a 


A 


vector  cross-product  operator 


The  elements  of  the  matrix  C^  are  cosines  of  the  angles  between  respective 

a 

coordinate  axes  of  frames  a  and  b.  The  direction  of  the  vector  0  .  is  the 
axis  of  rotation  from  frame  a  to  b;  the  magnitude  of  0^  is  the  angle  of 
rotation  from  a  to  b.  Note  that  the  components  of  0  ^  are  the  same  in  both 
frames  a  and  b: 


Cb  ea 

La  -ab 


(A-2) 


For  small  rotation  angles. 


the 


first-order  approximation  to 


C 


<< 


1: 


(A-3) 


A-1 


Consider  next  perturbed  rotation  variables  denoted  by  ('),  having  errors  6(  ) 
relative  to  the  true  values  (  ): 


?ab  1  -ab  + 


60 


ab 


(A-4 ) 


From  Eq.(A-l),  the  following  first-order  relationships  between  the  perturbed 
and  true  rotations  are  readily  derived: 

^  ■  C  -  “ab*»Cab  *  Cab"  -{?ab*> 

<  ■  <  -«&*><£  ■  cab  <  •  “Sb*’  (A-5> 

cab  =  (I  *  5-eabb*)Cab  *  *  “ab*> 

If  the  a-to-b  rotation  error  is  associated  with  a  perturbed  final 
frame  5,  the  initial  frame  a  being  fixed,  Eqs.  ( A- 5 )  can  be  written  as 

cl  =  cj  cj  =  (i-  &eb*)cl 

d  Da  •  D  a 

’  <Cb  -  '>Ca  ■  I’  5§b*)Cab  (A-6> 

ca  ’  c6  Ca  "(I  *  sSb*)Ca 

where 

r  A 

C D =  perturbed  coordinate  rotation  from  frame  a  to  f 

3 

A 

60^  =  vector  rotation  error  from  frame  b  to  6 

Alternately,  if  the  a-to-b  rotation  error  is  associated  with  a  perturbed 
initial  frame  a,  the  final  frame  b  being  fixed,  Eqs.  ( A- 5 )  can  be  written 


A-2 


(A- 7 ) 


(A-8) 


That  is,  6§ab  represents  the  general  a-to-b  rotation  error,  50b  the  forward 
rotation  error  of  the  final  frame  b  to  b,  and  50  the  backward  rotation 
error  o*  the  initial  frame  a  to  a. 
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APPENDIX  B: 


HOUSEHOLDER  TR : ANGULAR  1 2AT I  ON  PROCEDURE 


The  Householder  procedure  reduces  a  general  nxm  matrix  A  (where 
generally  m  >  n)  to  nxn  upper  or  lower  triangular  form  A+  via  a  sequence  of 
n  orthogonal  rotations.  To  be  specific,  we  will  consider  reduction  to  lower 
triangular  form.  (The  procedure  for  upper  triangular  form  simply  reverses 
the  order  of  computations.)  The  reduction  procedure  can  be  described  as 

A(n)  .  a(0)r(1 )r(2)  R(n) 

A  ’A  R  R  ...R  (B-l) 

A(k)  .  A(k-1 )R(k) 

where 

A^'  =  original  nxm  matrix  A 

A^  =  final  nxm  matrix  A+  in  lower  triangular  form 
(k) 

A  -  intermediate  matrix  with  first  k  rows  in  lower 

triangular  form  (zeroes  to  right  of  main  diagonal) 

(k) 

R  -  rotation  matrix  designed  to  rotate  elements  k  to  m 
of  row  k  such  that  ail  but  element  k  become  zero 


The  kth  step  of  this  process,  indicated  by  Eq.B-1  ,  can  be  described 
in  partitioned  form  as  follows: 


k-'  { 
n-k+1 1 


Aii  °ik 


A  +  A^) 

L  ki  Akk  J 


Aii  °ik 


A  +  A(k_1) 

Aki  Akk  J 


!ii  °ik 


°ki  Rkk 


A  .t  0.. 

ii  ik 


A  +  A(k'1]R 
ki  Akk  Kkk 


k-1  m-k+1 


k-1  m-k+1 


(B-2) 


(k-1  ) 

The  first  k-1  rows  and  columns  of  A  '  are  already  in  lower  triangular 
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form  and  are  not  affected  at  step  k.  Those  elements  below  and  to  the  right 
of  element  k,k  are  all  affected  at  step  k: 


A(k)  =  A(k-^  R 
Akk  Akk  Rkk 


(b-3) 


The  Householder  triangularization  procedure  at  this  step  can  be  des¬ 
cribed  in  terms  of  the  following  orthogonal  rotation  matrix  [62]:* 


R  =  R(r)  = 


rl/rn,  '  <t2/pm)T 

-r2/rn  1  -  rzIV'-J'W'J1' 


(B-4 ) 


where 


rT  Mr,  r2T) 

rm  •  VrT  I  S9"(r,)  ■  |r  |  sgn(r, ) 

The  matrix  R  rotates  the  vector  r  such  that  all  elements  but  the  first 
become  zero: 

rT+  .  rT  R 

r/  *  (rl2  *  r-2  n,  =  V  ( 

r-2*  ’  r-t  '  ‘  pl2  ‘  p2Tp2)  r;’  {r,*rm)'’  rj 

■  I2T  -  (r,*r,4)(r,*rm)-'  r/  ;  0T 


(B-5) 


(R  61 


Step  k  of  the  triangularization  process,  Eq.  (B-3),  can  be  performed  in 
terms  of  the  rotation  R  =  Rkk,  generalized  as  follows: 


This  form  and  the  result,  Eqs.  (B-8),  differ  slightly  from  the  standard 
Householder  procedure  [63];  the  computation  of  b|  is  somewhat  more  precise  here. 


fel  B2 


'1  -2 


(B-7) 


aj  *  \  a^  +  a_2  i2  sgn(a-|)=  Vaja  sgn(a-j) 


T+  nT 
a  2  =  0 


(b-8) 


=  (b]a1  +  B2^2)/a|  =  Ba/a| 

B2  =  B2  '  (^1  +  ^l)(al  +  al)_1  -2^ 


For  triangularization  step  k,  Eqs.  (b-8)  can  be  rewritten  in  terms  of 
elements  of  the  matrix  A  as  follows: 


ai^  =  +  •••  +  a l!  sgn(a.  .  ) 


ak]  =  0 

aik  =  (aik  akk  +  •••  +  aim  akm)/akk 


aij  =  aij  *  (aik  +  aik+>Kk  +  ak^_1  akj 


(b-9) 


where 


k  =  1  to  n 
j  =  k+1  to  m 


i  =  k+1  to  n 


Note  that,  in  Eqs.  (b-7)  to  (b-9),  any  column  j  >_  k  for  which  element 
a^j  is  already  zero  can  be  bypassed  in  the  step  k  calculations.  This 
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column  does  not  contribute  to  the  updated  elements  of  column  k,  nor  do 
its  own  elements  change.  If  akk  itself  is  zero,  the  entire  step  is 
bypassed.  These  facts  can  be  used  to  effect  significant  computational 
savings  when  the  nxm  matrix  A  is  already  partially  in  trianqular  form. 
For  example,  in  optimal  filter  and  smoother  formulations,  A  generally 
represents  the  combination  of  two  nxn  matrices  W,  V, 


A  =  [W  V]  |  n  (B  -10) 

T  T 

where  one  or  both  of  W,  V  may  already  be  in  triangular  form.  The  compu¬ 
tational  savings  are  rather  dramatic  in  such  cases: 


Form  of  Approx.  No.  of 

W,  V _ Mul  tipi  ications 


Both  square 

5  3 
3n 

One  square,  one 

triang. 

3  3 
3 

Both  triangular 

1  _3 
3" 

One  square,  one 

2  3 

zero 

3n 
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